Forgot to publish to the right topic
Change some defines in motorcontrol
Patching simulation so it actually drives, pretty shitty though but ah well