We need a delay in RS-485 because the arduino takes 80ms to transmit each byte and Serial.write() is non-blocking.
Re-enabled diagnostics. Now reporting incremental setpoints.
TEMPORARY: headCode is programmed to control the back vertibrae only.