M_limit_angle_to_pi
extern void M_limit_angle_to_pi(M_APM, int, M_APM);
M_limit_angle_to_pi(tmp3, (places + 6), a);
M_limit_angle_to_pi(tmp5, (places + 6), aa);