Beispiel #1
0
//Actions
void stop (USHORT acc)
{
	int motorcounter =0;
	lmotor.setAcceleration(acc);
	rmotor.setAcceleration(acc);

	lmotor.setTargetSpeed(0); //stop
	rmotor.setTargetSpeed(0);

	while ( rmotor.getCurrentSpeed()>1 && motorcounter<stop_timeout)
	{
		motorcounter++;
	}
}