fixed rotation math for gaits
Merge https://github.com/TXBDan/BETH_Raspi