   pushTo(x + w, y);
   pushCmd("PU");
   pushTo(x + w + letterSpacing, y);
+  
 }
 
 

      }
    } else {
      // pop and process next command from queue
      doLogoCommand(popCmd());
    }
  }
}

  
  // and distance
  float dist = sqrt(sqr(y-position.y) + sqr(x-position.x));
  String s = "FD ";
  s += dist;
  insertCmd(s);
}

void drive(float distance)
{ 
  Serial.print("Drive:");
  Serial.println(distance);
  // update state
  position.x += distance * cos(position.ang * PI / 180);
  position.y += distance * sin(position.ang * PI / 180);
