Austin Schuh | 2ca00ec | 2021-06-20 14:51:25 -0700 | [diff] [blame^] | 1 | #include <memory> |
| 2 | |
Stephan Massalt | d021f97 | 2020-01-05 20:41:23 -0800 | [diff] [blame] | 3 | #include "aos/events/shm_event_loop.h" |
| 4 | #include "aos/init.h" |
| 5 | #include "frc971/control_loops/drivetrain/drivetrain.h" |
| 6 | #include "y2020/control_loops/drivetrain/drivetrain_base.h" |
James Kuszmaul | 68f7d27 | 2020-02-22 20:55:02 -0800 | [diff] [blame] | 7 | #include "y2020/control_loops/drivetrain/localizer.h" |
Stephan Massalt | d021f97 | 2020-01-05 20:41:23 -0800 | [diff] [blame] | 8 | |
| 9 | using ::frc971::control_loops::drivetrain::DrivetrainLoop; |
| 10 | |
James Kuszmaul | 2d8fa2a | 2020-03-01 13:51:50 -0800 | [diff] [blame] | 11 | int main(int argc, char *argv[]) { |
| 12 | ::aos::InitGoogle(&argc, &argv); |
Stephan Massalt | d021f97 | 2020-01-05 20:41:23 -0800 | [diff] [blame] | 13 | |
| 14 | aos::FlatbufferDetachedBuffer<aos::Configuration> config = |
| 15 | aos::configuration::ReadConfig("config.json"); |
| 16 | |
| 17 | ::aos::ShmEventLoop event_loop(&config.message()); |
James Kuszmaul | 68f7d27 | 2020-02-22 20:55:02 -0800 | [diff] [blame] | 18 | ::y2020::control_loops::drivetrain::Localizer localizer( |
Stephan Massalt | d021f97 | 2020-01-05 20:41:23 -0800 | [diff] [blame] | 19 | &event_loop, ::y2020::control_loops::drivetrain::GetDrivetrainConfig()); |
Austin Schuh | 2ca00ec | 2021-06-20 14:51:25 -0700 | [diff] [blame^] | 20 | std::unique_ptr<DrivetrainLoop> drivetrain = std::make_unique<DrivetrainLoop>( |
Stephan Massalt | d021f97 | 2020-01-05 20:41:23 -0800 | [diff] [blame] | 21 | ::y2020::control_loops::drivetrain::GetDrivetrainConfig(), &event_loop, |
| 22 | &localizer); |
| 23 | |
| 24 | event_loop.Run(); |
| 25 | |
Stephan Massalt | d021f97 | 2020-01-05 20:41:23 -0800 | [diff] [blame] | 26 | return 0; |
| 27 | } |