Fixed SO3Trajectory, added Bezier interpolation for rotations
Fixed SO3Trajectory, added Bezier interpolation for rotations

krishauser/Klampt,krishauser/Klampt,krishauser/Klampt,krishauser/Klampt,krishauser/Klampt,krishauser/Klampt