Initial motor control code
Change baud rate for head controller

To match other controllers and simplify the device discovery
Fix relay control and initialization