improve pid and other stuff
This commit is contained in:
@@ -11,14 +11,14 @@ void CaptureRoute::init(Route *route, MoveControl *moveControl, MotorControl *mo
|
||||
}
|
||||
|
||||
void CaptureRoute::runCaptureRoute() {
|
||||
this->runManualControl();
|
||||
// this->runManualControl();
|
||||
|
||||
static uint64_t last_millis = 0;
|
||||
if (millis() - last_millis < RUN_CAPTuRE_ROUTE_DELAY) {
|
||||
return;
|
||||
}
|
||||
last_millis = millis();
|
||||
// static uint64_t last_millis = 0;
|
||||
// if (millis() - last_millis < RUN_CAPTuRE_ROUTE_DELAY) {
|
||||
// return;
|
||||
// }
|
||||
// last_millis = millis();
|
||||
|
||||
//Add Point to route
|
||||
this->route->addCurrentLocationToRoute();
|
||||
// this->route->addCurrentLocationToRoute();
|
||||
}
|
||||
@@ -49,7 +49,6 @@ void ManualControl::runManualControl() {
|
||||
switch (this->controlMode) {
|
||||
case ControMode::halt:
|
||||
this->moveControl->setDrivingStatus(DrivingStatus::stop);
|
||||
//this->reset();
|
||||
break;
|
||||
|
||||
case ControMode::joystick:
|
||||
|
||||
Reference in New Issue
Block a user