rai-opensource / spatialmath-python Python 655 118 Create, manipulate and convert representations of position and orientation in 2D or 3D using Python robot math 2d 3d