blob: 50fd0309f1c79e5c1e5f462ad3ff0189c5cacdcd [file] [log] [blame]
Austin Schuh378483c2019-01-20 16:36:40 -08001#include "aos/init.h"
2
Austin Schuh55a13dc2019-01-27 22:39:03 -08003#include "aos/events/shm-event-loop.h"
Austin Schuh378483c2019-01-20 16:36:40 -08004#include "frc971/control_loops/drivetrain/drivetrain.h"
5#include "y2019/control_loops/drivetrain/drivetrain_base.h"
6
7using ::frc971::control_loops::drivetrain::DrivetrainLoop;
8
9int main() {
10 ::aos::Init();
Austin Schuh55a13dc2019-01-27 22:39:03 -080011 ::aos::ShmEventLoop event_loop;
James Kuszmaul3431d622019-02-17 17:07:44 -080012 ::frc971::control_loops::drivetrain::DeadReckonEkf localizer(
13 ::y2019::control_loops::drivetrain::GetDrivetrainConfig());
Austin Schuh378483c2019-01-20 16:36:40 -080014 DrivetrainLoop drivetrain(
James Kuszmaul3431d622019-02-17 17:07:44 -080015 ::y2019::control_loops::drivetrain::GetDrivetrainConfig(), &event_loop,
16 &localizer);
Austin Schuh378483c2019-01-20 16:36:40 -080017 drivetrain.Run();
18 ::aos::Cleanup();
19 return 0;
20}