Added velocity interface to baxter
Enabled auto-enable feature again
Fixed switching controller functionality
Finished fixing mode switching
Control work
Merged