blob: 7e44ecbd94ce87189aa8bde5ca0436d63392da45 [file] [log] [blame]
Austin Schuh2ca00ec2021-06-20 14:51:25 -07001#include <memory>
Comran Morshed9a9948c2016-01-16 15:58:04 +00002
Alex Perrycb7da4b2019-08-28 19:35:56 -07003#include "aos/events/shm_event_loop.h"
Austin Schuh2ca00ec2021-06-20 14:51:25 -07004#include "aos/init.h"
Comran Morshed9a9948c2016-01-16 15:58:04 +00005#include "frc971/control_loops/drivetrain/drivetrain.h"
Comran Morshed6c6a0a92016-01-17 12:45:16 +00006#include "y2016/control_loops/drivetrain/drivetrain_base.h"
Comran Morshed9a9948c2016-01-16 15:58:04 +00007
8using ::frc971::control_loops::drivetrain::DrivetrainLoop;
9
Austin Schuh094d09b2020-11-20 23:26:52 -080010int main(int argc, char **argv) {
11 ::aos::InitGoogle(&argc, &argv);
Austin Schuh9fe68f72019-08-10 19:32:03 -070012
Alex Perrycb7da4b2019-08-28 19:35:56 -070013 aos::FlatbufferDetachedBuffer<aos::Configuration> config =
Austin Schuhc5fa6d92022-02-25 14:36:28 -080014 aos::configuration::ReadConfig("aos_config.json");
Alex Perrycb7da4b2019-08-28 19:35:56 -070015
16 ::aos::ShmEventLoop event_loop(&config.message());
James Kuszmaul3431d622019-02-17 17:07:44 -080017 ::frc971::control_loops::drivetrain::DeadReckonEkf localizer(
Austin Schuh9fe68f72019-08-10 19:32:03 -070018 &event_loop, ::y2016::control_loops::drivetrain::GetDrivetrainConfig());
Austin Schuh2ca00ec2021-06-20 14:51:25 -070019 std::unique_ptr<DrivetrainLoop> drivetrain = std::make_unique<DrivetrainLoop>(
James Kuszmaul3431d622019-02-17 17:07:44 -080020 ::y2016::control_loops::drivetrain::GetDrivetrainConfig(), &event_loop,
21 &localizer);
Austin Schuh9fe68f72019-08-10 19:32:03 -070022
23 event_loop.Run();
24
Comran Morshed9a9948c2016-01-16 15:58:04 +000025 return 0;
26}