Modifying format for motor signals...
Fixed some bugs... Seems to be working now
Merge branch 'f/modifyMotorSignals' into develop