Fixed bug in FloatPoint2D
Added FloatPoint3D and test