blob: 6e5b8451760c0aa20fb40a007d5941e146a37698 [file] [log] [blame]
John Park398c74a2018-10-20 21:17:39 -07001#include "aos/init.h"
Brian Silvermanc71537c2016-01-01 13:43:14 -08002
Austin Schuh55a13dc2019-01-27 22:39:03 -08003#include "aos/events/shm-event-loop.h"
Austin Schuh2a671df2016-11-26 15:00:06 -08004#include "frc971/control_loops/drivetrain/drivetrain.h"
5#include "y2012/control_loops/drivetrain/drivetrain_base.h"
6
7using ::frc971::control_loops::drivetrain::DrivetrainLoop;
8
Brian Silvermanc71537c2016-01-01 13:43:14 -08009int 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 ::y2012::control_loops::drivetrain::GetDrivetrainConfig());
Austin Schuh2a671df2016-11-26 15:00:06 -080014 DrivetrainLoop drivetrain(
James Kuszmaul3431d622019-02-17 17:07:44 -080015 ::y2012::control_loops::drivetrain::GetDrivetrainConfig(), &event_loop,
16 &localizer);
Brian Silvermanc71537c2016-01-01 13:43:14 -080017 drivetrain.Run();
18 ::aos::Cleanup();
19 return 0;
20}