[nextage_ik_plugin] In harmonize function: Limit angles to [-2*PI; 2*PI]

[ghost]

Hi,
I am reporting a minor bug about the harmonize function inside the two next files (line 482, indigo-devel branch):
rtmros_nextage/nextage_ik_plugin/src/nextage_left_arm_ikfast_moveit_plugin.cpp
rtmros_nextage/nextage_ik_plugin/src/nextage_right_arm_ikfast_moveit_plugin.cpp

A minus sign was missing in order to properly limit the angles in [-2PI; 2PI]
It is fixed with this pull request. It was tested with the simulator.

Regards,
Yoann.

[k-okada]

1. please provide a example/test code to reproduce the problem
2. if your investigation is correct, that's because of https://github.com/ros-planning/moveit/blob/c9228603c58c260437a56c94233210b6dbab3def/moveit_kinematics/ikfast_kinematics_plugin/templates/ikfast61_moveit_plugin_template.cpp#L564-L585, you'd better to send pull request to https://github.com/ros-planning/moveit and assign @130s ;-)

[130s]

I'm not keen on ikfast so no need to point to me. Plenty others are.