added some useful functions in geometry
Added handling of rotation speed in position