Fixed so3 interpolation and integration, difference returns derivative of interpolate function
Fixed so3 interpolation and integration, difference returns derivative of interpolate function

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