added moveToOrigin and moveToGroundPlane functions