Added derivative of rotation matrix