Added InverseKinematics for SL, started working on SwingLeg code & many small changes.