add FixedPoint

git-svn-id: svn://db.shs.com.ru/pip@59 12ceb7fc-bf1f-11e4-8940-5bc7170c53b5

src/math/pifixedpoint.h

@@ -0,0 +1,100 @@
+/*! \file pifixedpoint.h
+ * \brief Class for fixed point numbers
+*/
+/*
+	PIP - Platform Independent Primitives
+	Class for fixed point numbers
+	Copyright (C) 2015  Andrey Bychkov work.a.b@yandex.ru
+
+	This program is free software: you can redistribute it and/or modify
+	it under the terms of the GNU General Public License as published by
+	the Free Software Foundation, either version 3 of the License, or
+	(at your option) any later version.
+
+	This program is distributed in the hope that it will be useful,
+	but WITHOUT ANY WARRANTY; without even the implied warranty of
+	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+	GNU General Public License for more details.
+
+	You should have received a copy of the GNU General Public License
+	along with this program.  If not, see <http://www.gnu.org/licenses/>.
+*/
+
+#ifndef PIFIXEDPOINT_H
+#define PIFIXEDPOINT_H
+template<int Precision = 0, typename Type = int>
+class FixedPoint {
+//	friend PICout operator <<(PICout s, const FixedPoint<> & v);
+public:
+	typedef FixedPoint<Precision, Type> fp;
+	FixedPoint(const Type &v = Type()) {val = fpv(v);}
+	FixedPoint(const fp &v) {val = v.val;}
+	FixedPoint(const float &v) {val = Precision == 0 ? Type(v) : Type(v * (2 << Precision-1));}
+	FixedPoint(const double &v) {val = Precision == 0 ? Type(v) : Type(v * (2 << Precision-1));}
+//	FixedPoint(const long double &v) {val = Precision == 0 ? Type(v) : Type(v * (2 << Precision-1));}
+
+	template<typename T>
+	fp & operator=(const T & v) {val = fpv(Type(v)); return *this;}
+	fp & operator=(const fp & v) {val = v.val; return *this;}
+	fp & operator=(const float &v) {val = FixedPoint(v).val; return *this;}
+	fp & operator=(const double &v) {val = FixedPoint(v).val; return *this;}
+	fp & operator=(const long double &v) {val = FixedPoint(v).val; return *this;}
+	fp & operator-() {fp p = fp(*this); p.val = -val; return p;}
+	bool operator==(const fp & v) const {val == v.val;}
+	bool operator!=(const fp & v) const {val != v.val;}
+
+	void operator+=(const fp & v) {val += v.val;}
+	void operator-=(const fp & v) {val -= v.val;}
+
+	void operator*=(const fp & v) {val = fpi(val *v.val);}
+	void operator/=(const fp & v) {val = fpv(val) / v.val;}
+
+	fp operator+(const fp & v) {fp p = fp(*this); p.val += v.val; return p;}
+	fp operator-(const fp & v) {fp p = fp(*this); p.val -= v.val; return p;}
+
+	fp operator*(const fp & v) {fp p; p.val = fpi(val * v.val); return p;}
+	fp operator/(const fp & v) {fp p; p.val = fpv(val) / v.val; return p;}
+
+	/*fp & operator =(const Type & v) {val = fpv(v); return *this;}
+	bool operator ==(const Type & v) const {val == fpv(v);}
+	bool operator !=(const Type & v) const {val != fpv(v);}
+	void operator +=(const Type & v) {val += fpv(v);}
+	void operator -=(const Type & v) {val -= fpv(v);}
+	void operator *=(const Type & v) {val *= fpv(v);}
+	void operator /=(const Type & v) {val /= fpv(v);}
+	fp operator +(const Type & v) {fp p = fp(*this); p.val += fpv(v); return p;}
+	fp operator -(const Type & v) {fp p = fp(*this); p.val -= fpv(v); return p;}
+	fp operator *(const Type & v) {fp p = fp(*this); p.val *= fpv(v); return p;}
+	fp operator /(const Type & v) {fp p = fp(*this); p.val /= fpv(v); return p;}*/
+
+	Type fpv(Type v) const {return Type(v << Precision);}
+	Type fpi(Type v) const {return Type(v >> Precision);}
+	Type fpc(Type v) const {return v - fpv(fpi(v));}
+	Type val;
+};
+
+template<int Precision, typename Type>
+inline PICout operator <<(PICout s, const FixedPoint<Precision, Type> & v) {
+	s.space(); s.setControl(0, true);
+	if (Precision == 0) s << v.val;
+	else {
+		std::stringstream ss,sr;
+		Type tmp = 10;
+		int n = 1;
+		Type rs = (2 << Precision-1);
+		while(tmp < rs) tmp = tmp*10, n++;
+		tmp *= 10; n++;
+		Type rv = v.fpc(v.val);
+		if (rv != 0) tmp = tmp / (rs / rv);
+		ss << tmp;
+		PIString r = ss.str();
+		if (rv == 0) r.pop_front();
+		else r.expandLeftTo(n,'0');
+		sr << v.fpi(v.val);
+		s << PIString(sr.str()) + "." + r;
+	}
+	s.restoreControl();
+	return s;
+}
+
+#endif // PIFIXEDPOINT_H