Foot now moves to floor correctly, with debug code still included