package org.robockets.stronghold.robot;

import com.kauailabs.nav6.frc.IMUAdvanced;

import edu.wpi.first.wpilibj.Encoder;
import edu.wpi.first.wpilibj.RobotDrive;
import edu.wpi.first.wpilibj.SerialPort;
import edu.wpi.first.wpilibj.Victor;

/**
 * The RobotMap is a mapping from the ports sensors and actuators are wired into
 * to a variable name. This provides flexibility changing wiring, makes checking
 * the wiring easier and significantly reduces the number of magic numbers
 * floating around.
 */
public class RobotMap {
	private static SerialPort navXSerialPort = new SerialPort(57600, SerialPort.Port.kMXP);
	private static byte updateRateHz = 50;
	public static IMUAdvanced navX = new IMUAdvanced(navXSerialPort, updateRateHz);
	public static RobotDrive robotDrive = new RobotDrive(1, 2, 3, 4);
	public static Victor intakeMotor = new Victor(5); //TEMP
	public static Encoder intakeEncoder = new Encoder(3, 4);
	public static Victor intakeVerticalMotor = new Victor(11); //TEMP
	public static Victor jeffRoller1 = new Victor(6); // TEMP
	public static Victor jeffRoller2 = new Victor(7); // TEMP
	public static Victor shootingWheelMotor = new Victor(8);
	public static Victor turnTableMotor = new Victor(9); // TEMP
	public static Encoder turnTableEncoder = new Encoder(5, 6);
	public static Victor hoodMotor = new Victor(10); // TEMP
	public static Encoder hoodEncoder = new Encoder(7, 8);
	public static Encoder driveEncoder = new Encoder(9, 10);
	
	public RobotMap () {
		navX.zeroYaw();
	}
}

@@ -793,18 +793,12 @@
 ive(
-1, 2, 3, 4
+0, 1
 );%0A%09
@@ -843,17 +843,17 @@
  Victor(
-5
+2
 ); //TEM
@@ -971,10 +971,9 @@
 tor(
-11
+3
 ); /
@@ -1025,17 +1025,17 @@
  Victor(
-6
+4
 ); // TE
@@ -1084,17 +1084,17 @@
  Victor(
-7
+5
 ); // TE
@@ -1150,17 +1150,17 @@
  Victor(
-8
+6
 );%0A%09publ
@@ -1204,17 +1204,17 @@
  Victor(
-9
+7
 ); // TE
@@ -1322,18 +1322,17 @@
  Victor(
-10
+8
 ); // TE

Update motor PWM ports for newly completed drivetrain