working forward/backward/sidestep/stop with zmpgui
Merge attempt with pete
Adapted Pete's code to the ach interface
Trying to make pipeline work