Can now respond to action. (Doesnt do anything yet)
Stop action seems to work
Changed the KP parameters to be the same
We think we fixed the motor controller hiccup bug by setting buffer size to 1. 0 Is apparantly unlimited.