use engine::Engine;
use pid::pid_controller::PidController;
pub mod engine;
pub mod pid;
pub mod servo;
struct InterfaceController {
out_amp: f64,
}
impl InterfaceController {
fn new() -> Self {
Self { out_amp: 0.0 }
}
fn read(&self) -> f64 {
0.0
}
fn set(&mut self, amp: f64) {
self.out_amp = amp;
}
}
#[allow(dead_code)]
fn main() {
let goal_set_point = 100.0;
let pid_controller = PidController::new(goal_set_point);
let mut controller = InterfaceController::new();
let mut engine = Engine::new(pid_controller);
loop {
let val = controller.read();
let control_output = engine.next(val);
controller.set(val + control_output.value);
std::thread::sleep(std::time::Duration::from_secs(1));
}
}