Refactoring of movement code to multithread each limb