Disabled normalization in angularvel2quatdotMatrix. This was causing testForwardKinV to fail.