Timing issues fixed; Gait Gen Partially fn

+ need to fix junction control gains on gaiter
+ need to check junction motion directions against chosen index