commit e139f80f6dd0f4cbfa6036a952d89e7003e9f039
author Henry Speiser <henry@speiser.net> Tue Feb 21 14:14:48 2023 -0800
committer Henry Speiser <henry@speiser.net> Tue Feb 21 14:35:07 2023 -0800
tree 3411f87247541cc6d232c76380932e0317841668
parent eb80f88a67de13531f20a5177baabad113578669

Fix issues in wpilib and the roborio config and add ports

Signed-off-by: Henry Speiser <henry@speiser.net>
Change-Id: Iecd2347036278e1289e8aa07f7712b67b448d9ea

y2023/wpilib_interface.cc

diff --git a/y2023/wpilib_interface.cc b/y2023/wpilib_interface.cc
index 84be099..af16a69 100644
--- a/y2023/wpilib_interface.cc
+++ b/y2023/wpilib_interface.cc
@@ -198,6 +198,7 @@
       position_builder.add_arm(arm_offset);
       position_builder.add_roll_joint(roll_joint_offset);
       position_builder.add_wrist(wrist_offset);
+      builder.CheckOk(builder.Send(position_builder.Finish()));
     }
 
     {
@@ -791,26 +792,25 @@
     sensor_reader.set_drivetrain_left_encoder(make_encoder(1));
     sensor_reader.set_drivetrain_right_encoder(make_encoder(0));
     sensor_reader.set_superstructure_reading(superstructure_reading);
-
-    sensor_reader.set_heading_input(make_unique<frc::DigitalInput>(9));
-    sensor_reader.set_yaw_rate_input(make_unique<frc::DigitalInput>(8));
+    sensor_reader.set_heading_input(make_unique<frc::DigitalInput>(1));
+    sensor_reader.set_yaw_rate_input(make_unique<frc::DigitalInput>(0));
 
     sensor_reader.set_proximal_encoder(make_encoder(3));
     sensor_reader.set_proximal_absolute_pwm(make_unique<frc::DigitalInput>(3));
     sensor_reader.set_proximal_potentiometer(make_unique<frc::AnalogInput>(3));
 
-    sensor_reader.set_distal_encoder(make_encoder(3));
-    sensor_reader.set_distal_absolute_pwm(make_unique<frc::DigitalInput>(3));
-    sensor_reader.set_distal_potentiometer(make_unique<frc::AnalogInput>(3));
+    sensor_reader.set_distal_encoder(make_encoder(2));
+    sensor_reader.set_distal_absolute_pwm(make_unique<frc::DigitalInput>(2));
+    sensor_reader.set_distal_potentiometer(make_unique<frc::AnalogInput>(2));
 
-    sensor_reader.set_roll_joint_encoder(make_encoder(3));
+    sensor_reader.set_roll_joint_encoder(make_encoder(5));
     sensor_reader.set_roll_joint_absolute_pwm(
-        make_unique<frc::DigitalInput>(3));
+        make_unique<frc::DigitalInput>(5));
     sensor_reader.set_roll_joint_potentiometer(
-        make_unique<frc::AnalogInput>(3));
+        make_unique<frc::AnalogInput>(5));
 
-    sensor_reader.set_wrist_encoder(make_encoder(3));
-    sensor_reader.set_wrist_absolute_pwm(make_unique<frc::DigitalInput>(3));
+    sensor_reader.set_wrist_encoder(make_encoder(4));
+    sensor_reader.set_wrist_absolute_pwm(make_unique<frc::DigitalInput>(4));
 
     AddLoop(&sensor_reader_event_loop);
 
@@ -846,17 +846,17 @@
         ctre::phoenixpro::signals::InvertedValue::Clockwise_Positive);
     drivetrain_writer.set_left_inverted(
         ctre::phoenixpro::signals::InvertedValue::CounterClockwise_Positive);
-
     SuperstructureWriter superstructure_writer(&output_event_loop);
 
-    superstructure_writer.set_proximal_falcon(make_unique<::frc::TalonFX>(3));
-    superstructure_writer.set_distal_falcon(make_unique<::frc::TalonFX>(3));
+    superstructure_writer.set_proximal_falcon(make_unique<::frc::TalonFX>(1));
+    superstructure_writer.set_distal_falcon(make_unique<::frc::TalonFX>(0));
 
     superstructure_writer.set_roll_joint_victor(
-        make_unique<::frc::VictorSP>(5));
-    superstructure_writer.set_wrist_victor(make_unique<::frc::VictorSP>(5));
+        make_unique<::frc::VictorSP>(3));
+    superstructure_writer.set_wrist_victor(make_unique<::frc::VictorSP>(2));
+
     superstructure_writer.set_roller_falcon(
-        make_unique<::ctre::phoenix::motorcontrol::can::TalonFX>(5));
+        make_unique<::ctre::phoenix::motorcontrol::can::TalonFX>(0));
 
     superstructure_writer.set_superstructure_reading(superstructure_reading);