max/ev3dev-pid-linefollow
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Loop

Browse Source
This commit is contained in:
Max Känner 2023-01-29 15:04:46 +01:00
parent 63534c7e05
commit a5dc6f15af
1 changed files with 21 additions and 22 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

43
src/main.rs
View File

@ -37,32 +37,31 @@ fn main() -> Result<(), Box<dyn Error>> {
let white = calibrate_gray(&mut screen, &sensor, &mut buttons, "Weiß", &font)?; let white = calibrate_gray(&mut screen, &sensor, &mut buttons, "Weiß", &font)?;
let setpoint = (black + white) / 2.0; let setpoint = (black + white) / 2.0;
let (k_p, k_i, k_d, v) = select_values(&mut screen, &mut buttons, &font); loop {
let (k_p, k_i, k_d, v) = select_values(&mut screen, &mut buttons, &font);
draw_driving(&mut screen, &font); draw_driving(&mut screen, &font);
let result = follow_line(
(&left_motor, &right_motor),
&sensor,
&mut buttons,
setpoint,
(k_p / 10.0, k_i / 100.0, k_d / 100.0),
v,
);
left_motor.stop().and(right_motor.stop())?;
let time = match result {
Ok(time) => time,
Err(ProgramError::UserAbort) => continue,
e => e?,
};
let result = follow_line( draw_finished(&mut screen, time, &font);
(&left_motor, &right_motor),
&sensor,
&mut buttons,
setpoint,
(k_p / 10.0, k_i, k_d),
v,
);
left_motor.stop().and(right_motor.stop())?;
let time = match result {
Ok(time) => time,
Err(ProgramError::UserAbort) => return Ok(()),
e => e?,
};
buttons.process();
draw_finished(&mut screen, time, &font);
while !buttons.is_enter_pressed() {
buttons.process(); buttons.process();
while !buttons.is_enter_pressed() {
buttons.process();
}
} }
Ok(())
} }
fn select_values( fn select_values(