angular dynamics of the pole now works.
angular dynamics of the pole now works. Need to recheck the math with the angular stuff