robot bits drawing, ik not working
fixed and improved some bits, still not working
moved visualizer state into class
fixed colors in helper functions
changed points in robot spec to be relative to the robot's controlled center of rotation
changes to how the robot's center is displayed
position_body seems to be working