Added Odometry and Baseplate for Trajectory

Need to still add Autonomous Command for actual Trajectory.
This commit is contained in:
Aarav Shah
2020-02-10 20:13:15 -07:00
parent 68a39f8eca
commit 27824bdcfc
3 changed files with 202 additions and 106 deletions
@@ -10,6 +10,8 @@ package frc4388.robot;
import com.ctre.phoenix.motorcontrol.NeutralMode;
import edu.wpi.first.wpilibj.Joystick;
import edu.wpi.first.wpilibj.controller.SimpleMotorFeedforward;
import edu.wpi.first.wpilibj.trajectory.constraint.DifferentialDriveVoltageConstraint;
import edu.wpi.first.wpilibj2.command.Command;
import edu.wpi.first.wpilibj2.command.InstantCommand;
import edu.wpi.first.wpilibj2.command.RunCommand;