clean up xyx and rpy by setting to 0 in ax12. using joints before hand to orient ax12