blob: 774963149f1a112d1b696a4192e385482180480e [file] [log] [blame]
John Park398c74a2018-10-20 21:17:39 -07001#include "aos/init.h"
Brian Silverman17f503e2015-08-02 18:17:18 -07002
Austin Schuh55a13dc2019-01-27 22:39:03 -08003#include "aos/events/shm-event-loop.h"
Comran Morshed5323ecb2015-12-26 20:50:55 +00004#include "frc971/control_loops/drivetrain/drivetrain.h"
Austin Schuh55a13dc2019-01-27 22:39:03 -08005#include "y2014/control_loops/drivetrain/drivetrain_base.h"
Comran Morshed5323ecb2015-12-26 20:50:55 +00006
7using ::frc971::control_loops::drivetrain::DrivetrainLoop;
8
Brian Silverman17f503e2015-08-02 18:17:18 -07009int main() {
Austin Schuh9fe68f72019-08-10 19:32:03 -070010 ::aos::InitNRT(true);
11
Austin Schuh55a13dc2019-01-27 22:39:03 -080012 ::aos::ShmEventLoop event_loop;
James Kuszmaul3431d622019-02-17 17:07:44 -080013 ::frc971::control_loops::drivetrain::DeadReckonEkf localizer(
Austin Schuh9fe68f72019-08-10 19:32:03 -070014 &event_loop, ::y2014::control_loops::GetDrivetrainConfig());
Austin Schuh55a13dc2019-01-27 22:39:03 -080015 DrivetrainLoop drivetrain(::y2014::control_loops::GetDrivetrainConfig(),
James Kuszmaul3431d622019-02-17 17:07:44 -080016 &event_loop, &localizer);
Austin Schuh9fe68f72019-08-10 19:32:03 -070017
18 event_loop.Run();
19
Brian Silverman17f503e2015-08-02 18:17:18 -070020 ::aos::Cleanup();
21 return 0;
22}