Control work from left foot to right foot
Only need to fix angle calculationw