summaryrefslogtreecommitdiff
path: root/src/org/usfirst/frc/team4272/robot2016/HwRobot.java
blob: a59ecb15db1bd7459a6cf8d9c50ace4b4ce57a30 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
package org.usfirst.frc.team4272.robot2016;

import org.usfirst.frc.team4272.robotlib.PIDOutputSplitter;

import edu.wpi.first.wpilibj.Encoder;
import edu.wpi.first.wpilibj.PIDOutput;
import edu.wpi.first.wpilibj.PIDSourceType;
import edu.wpi.first.wpilibj.Talon;

public class HwRobot {
	/* Relay == a Spike */
	/* PCM = Pneumatics Control Module */

	/* All of the numbered inputs are in the classes:
	 * - DIO: 0-9
	 * - Relay: 0-3
	 * - Analog In: 0-3
	 * - PWM: 0-9
	 * - PCM: 0-7 (the PCM is connected via CAN).
	 * - CAN
	 *
	 * For completeness, the roboRIO also has: i2c, RS-232, SPI,
	 * RSL, 2xUSB-A, an accelerometer, and an expansion port.
	 *
	 * And, for communication: USB-B and Ethernet.
	 */

	// naming convention: {side_letter}{Thing}{E|M (encoder/motor)}

	//public Encoder   lDriveE = new Encoder(/*DIO*/2,/*DIO*/3);
	//public Encoder   rDriveE = new Encoder(/*DIO*/0,/*DIO*/1, true);
	private PIDOutput lDriveM = new PIDOutputSplitter(new Talon(/*PWM*/0), new Talon(/*PWM*/1));
	private PIDOutput rDriveM = new PIDOutputSplitter(new Talon(/*PWM*/2), new Talon(/*PWM*/3));
	private PIDOutput armM    = new PIDOutputSplitter(new Talon(/*PWM*/4), new Talon(/*PWM*/5));
	private PIDOutput fBallM  = new PIDOutputSplitter(new Talon(/*PWM*/6), new Talon(/*PWM*/7));
	private PIDOutput bBallM  = new PIDOutputSplitter(new Talon(/*PWM*/8), new Talon(/*PWM*/9));

	public HwRobot() {
		//lDriveE.setPIDSourceType(PIDSourceType.kRate);
		//rDriveE.setPIDSourceType(PIDSourceType.kRate);
	}

	public void run(Control c) {
		lDriveM.pidWrite( c.lDrive);
		rDriveM.pidWrite(-c.rDrive);
		armM.pidWrite(-c.arm);
		fBallM.pidWrite(-c.fBall);
		bBallM.pidWrite(-c.bBall);
	}
}