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]
Merge pull request #20 from jpmerc/hydro-devel

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