 {
   if (action) ssc.begin(38400);
   else ssc.end();
-}
-
-// ex: sp000500 - set servo 00 to the min position
-// ex: sp152500 - set servo 15 to the max position
-void servo_ssc32()
-{
-  uint8_t channel;
-  uint16_t pos, time;
-  cmd = buf[1];
-  
-  if (cmd == 'p') // servo pulse
-  {
-    channel = bctoi(2, 2);
-    pos = bctoi16(4, 4);
-    time = bctoi16(8, 4);
-    if (channel > 31) err();
-    else
-    {
-      ssc.print("#");
-      ssc.print(channel);
-      ssc.print("P");
-      ssc.print(pos);
-      if (time > 0) { ssc.print("T"); ssc.print(time); }
-      ssc.println("");
-    }
-  }
-  else
-  {
-    nak();
-  }
 }
 
 //=======================================

// ex: dm000000 - full backward
void drive()
{
  cmd = buf[1];
  
  if (cmd == 'm') // drive motors
  {
    motor1_target = bctoi(2, 3);

  digitalWrite(MOTOR_DISABLE_PIN, LOW);
  motor_power(false);
  
  // TM1650 display setup
  Wire.begin();
  tm.init();
  tm.displayOff();
  tm.displayString("INIT");
  tm.setBrightness(1);
  tm.displayOn();
  
  // host communication //
  Serial.begin(38400);
  
