John Park | 398c74a | 2018-10-20 21:17:39 -0700 | [diff] [blame] | 1 | #include "aos/init.h" |
Comran Morshed | 9a9948c | 2016-01-16 15:58:04 +0000 | [diff] [blame] | 2 | |
Austin Schuh | 55a13dc | 2019-01-27 22:39:03 -0800 | [diff] [blame] | 3 | #include "aos/events/shm-event-loop.h" |
Comran Morshed | 9a9948c | 2016-01-16 15:58:04 +0000 | [diff] [blame] | 4 | #include "frc971/control_loops/drivetrain/drivetrain.h" |
Comran Morshed | 6c6a0a9 | 2016-01-17 12:45:16 +0000 | [diff] [blame] | 5 | #include "y2016/control_loops/drivetrain/drivetrain_base.h" |
Comran Morshed | 9a9948c | 2016-01-16 15:58:04 +0000 | [diff] [blame] | 6 | |
| 7 | using ::frc971::control_loops::drivetrain::DrivetrainLoop; |
| 8 | |
| 9 | int main() { |
Austin Schuh | 9fe68f7 | 2019-08-10 19:32:03 -0700 | [diff] [blame] | 10 | ::aos::InitNRT(true); |
| 11 | |
Austin Schuh | 55a13dc | 2019-01-27 22:39:03 -0800 | [diff] [blame] | 12 | ::aos::ShmEventLoop event_loop; |
James Kuszmaul | 3431d62 | 2019-02-17 17:07:44 -0800 | [diff] [blame] | 13 | ::frc971::control_loops::drivetrain::DeadReckonEkf localizer( |
Austin Schuh | 9fe68f7 | 2019-08-10 19:32:03 -0700 | [diff] [blame] | 14 | &event_loop, ::y2016::control_loops::drivetrain::GetDrivetrainConfig()); |
Austin Schuh | ba93d9e | 2016-03-18 22:38:57 -0700 | [diff] [blame] | 15 | DrivetrainLoop drivetrain( |
James Kuszmaul | 3431d62 | 2019-02-17 17:07:44 -0800 | [diff] [blame] | 16 | ::y2016::control_loops::drivetrain::GetDrivetrainConfig(), &event_loop, |
| 17 | &localizer); |
Austin Schuh | 9fe68f7 | 2019-08-10 19:32:03 -0700 | [diff] [blame] | 18 | |
| 19 | event_loop.Run(); |
| 20 | |
Comran Morshed | 9a9948c | 2016-01-16 15:58:04 +0000 | [diff] [blame] | 21 | ::aos::Cleanup(); |
| 22 | return 0; |
| 23 | } |