forked from nschundi/Smith-FTC-Code
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathRobotHardware.java
87 lines (68 loc) · 2.95 KB
/
RobotHardware.java
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
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
package org.firstinspires.ftc.teamcode;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.hardware.DcMotor;
import com.qualcomm.robotcore.hardware.Servo;
import com.qualcomm.robotcore.util.Range;
import com.qualcomm.robotcore.hardware.HardwareMap;
import com.qualcomm.robotcore.util.ElapsedTime;
import com.qualcomm.robotcore.hardware.GyroSensor;
public class RobotHardware
{
/* Declare OpMode members. */
private LinearOpMode myOpMode = null; // gain access to methods in the calling OpMode.
//ISTANTIATE MOTORS AND SERVOS//
public DcMotor motor1;
public DcMotor motor2;
public DcMotor motor3;
public DcMotor motor4;
public DcMotor motor5;
public Servo servo0;
public Servo servo1;
/*
//ISTANTIATE SENSORS
public GyroSensor gyroSensor;
*/
// CREATING THE HARDWARE MAP
HardwareMap hardwareMap;
public void init(HardwareMap hardwareMap) {
// DEFINIE MOTORS AND SERVOS
// motor0 = harwareMap.get(DcMotor.class, "motor0");
motor1 = hardwareMap.get(DcMotor.class, "motor1");
motor2 = hardwareMap.get(DcMotor.class, "motor2");
motor3 = hardwareMap.get(DcMotor.class, "motor3");
motor4 = hardwareMap.get(DcMotor.class, "motor4");
motor5 = hardwareMap.get(DcMotor.class, "motor5");
servo0 = hardwareMap.get(Servo.class, "servo0");
servo1 = hardwareMap.get(Servo.class, "servo1");
//DEFINE SENSORS
//gyroSensor = hardwareMap.get(GyroSensor.class, "gyroSensor");
//SET MOTOR POWER
// motor0.setPower(0);
motor1.setPower(0);
motor2.setPower(0);
motor3.setPower(0);
motor4.setPower(0);
motor5.setPower(0);
// servo0.setDirection(REVERSE);
// servo1.setDirection(REVERSE);
//SET MOTOR MODE
// motor0.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
motor1.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
motor2.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
motor3.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
motor4.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
motor5.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
//SET MOTOR TO zeroPowerBehavior
// motor0.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.BRAKE);
motor1.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.BRAKE);
motor2.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.BRAKE);
motor3.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.BRAKE);
motor4.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.BRAKE);
motor5.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.BRAKE);
//SET SERVO POSITION
servo0.setPosition(130);
servo1.setPosition(0);
// CALIBRATE SENSORS
//gyroSensor.calibrate();
}
}