forwardKin gradients.
Added normalization + gradient to angularvel2quatdotMatrix for safety.