Dev/ik debug viz

Implement debug tools for IK:

Add history to IK Info if debug option set for IK (triggered in one test case)

2D plot of angle/steps/step size vs. optimization step and reset

3D plot of eef trajectory for each optimization try