-
Notifications
You must be signed in to change notification settings - Fork 0
/
SimpleTankTeleop.c
39 lines (35 loc) · 975 Bytes
/
SimpleTankTeleop.c
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
#pragma config(Hubs, S4, HTMotor, none, none, none)
#pragma config(Motor, mtr_S4_C1_1, starboard, tmotorTetrix, openLoop)
#pragma config(Motor, mtr_S4_C1_2, port, tmotorTetrix, openLoop)
//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
#include "JoystickDriver.c"
#include "MotorToServo.c"
void initializeRobot(){
return;}
task main(){
initializeRobot();
//Initialize variables
float SPEEDRATIO = .78125;
int portpower = 0;
int starboardpower = 0;
//End Initialize variables
waitForStart();
while (true){
getJoystickSettings(joystick);
nxtDisplayCenteredTextLine(4,"%d",joystick.joy1_y1);
portpower = joystick.joy1_y1*SPEEDRATIO;
starboardpower = joystick.joy1_y2*SPEEDRATIO;
if(abs(portpower) > 10){
motor[port] = portpower;
}
else{
motor[port] = 0;
}
if(abs(starboardpower) > 10){
motor[starboard] = starboardpower;
}
else{
motor[starboard] = 0;
}
}
}