Sketchbot Testing for Lego Mindstorm

Figuring out IK functions