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