   dlcs("FD 2000");
   
 }
+
+long sqr(long v) {
+  return v*v;
+}

      SIG - sign Logobots name
    */  
  
  if (cmd.startsWith("FD")) {
    int dist = cmd.substring(3).toInt();
    driveForward(dist);
  } else if (cmd.startsWith("BK")) {
    int dist = cmd.substring(3).toInt();
    driveBackward(dist);
  } else if (cmd.startsWith("RT")) {
    int angle = cmd.substring(3).toInt();
    rightTurn(angle * 3760.0 / 180.0);
  } else if (cmd.startsWith("LT")) {
    int angle = cmd.substring(3).toInt();
    leftTurn(angle * 3760.0 / 180.0);
  } else if (cmd.startsWith("ST")) {
    stepperL.stop();
    stepperR.stop();
  } else if (cmd.startsWith("BZ")) {
    buzz(cmd.substring(3).toInt());
  } else if (cmd.startsWith("PU")) {
    penUp();
  } else if (cmd.startsWith("PD")) {
    penDown();
  } else if (cmd.startsWith("SIG")) {
    sign();
  }
}


  penliftServo.write(90);
}

void writeChar(char c) {
    switch(c) {
        case 'L':
          pushCmd("FD 100");
          pushCmd("PD");
          pushCmd("BK 100");
          pushCmd("RT 90");
          pushCmd("FD 80");
          pushCmd("PU");
          
          pushCmd("FD 50");
          break;
        
        default:
          pushCmd("BZ 500");
          break;
    }
}

void writeText(String s) {
  // overwrite write text
  text = s; 
  
  // reset current state
  resetPosition();
}

void writeLogobot()
{
  // L
  dlcs("FD 100");
