private void driveTo(float posbx, float posby, float dirc) throws Exception {
LCD.clear();
LCD.drawString("DriveTo1", 0, 0);
LCD.drawString("a" + dirc, 0, 1);
LCD.drawString("x" + posbx, 0, 2);
LCD.drawString("y" + posby, 0, 3);
LCD.drawString("nang" + nang, 0, 4);
//Navigator driveTo(X,Y,angle)
//Ausrichtung festlegen
if (nang != true) {
//Winkel im math. Sinne
getangle = -cs.getDegrees();
nang = true;
}
//sanft Beschleunigen
Motor.A.smoothAcceleration(true);
Motor.C.smoothAcceleration(true);
...