fixed up AngleControlTest
REMOVEME added some debug info to motion control