Fixing some things in IK and adding a basic walk for the fore legs
Adding debug features for IK and swapping the fixation of the legs