fixed AngleControlTest play, fixed angle motion control
got angle control lookin decent