add some comments
remove Point3d class, modify Matrix3d to support transformPoint and transformDirection vel vector3d