updated a ton of stuff in robot arm class
inverse kinematics appears to be working