removed angle normalization of joints 1,4,5,6 to allow full rotations

The removal of the angle normalization allows the joints to rotate outside of the range [-pi,pi]