worked out inverse kinematics, added elbow angle mapping