Merged in CorrectInclineAngle (pull request #15)
Make sure the incline angle is between -pi/2 and pi/2 ...
Make sure the incline angle is between -pi/2 and pi/2 ...