-#include "variant.h"
 #include <stdio.h>
 #include <adk.h>
 #include "DualMC33926MotorShield.h"


  // Starting listening when ADK is available
  if (adk.isReady()) {
      adk.read(&bytesRead, BUFFSIZE, buffer);
    if (bytesRead > 0) {
      jeepCommandInterpreter(extractMovement(), extractSpeed());
    }


void jeepCommandInterpreter(uint8_t commandMovement, unsigned int commandSpeed) {
  unsigned int vPower = motorProtection(commandSpeed);
  Serial.print("Required power: "); Serial.println(vPower);

  switch (commandMovement) {
    case 0:
      Serial.println("Received command: 0 -> move forward");
      goForward(vPower);
