shark/mobilerobotics
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Update 'main.c'

Browse Source
This commit is contained in:
Cole Deck
2019-04-03 17:22:56 -05:00
parent d3031766aa
commit f72cd3546c
1 changed files with 30 additions and 22 deletions
Download Patch File Download Diff File Expand all files Collapse all files

26
main.c
View File

@@ -1,11 +1,11 @@
#pragma config(I2C_Usage, I2C1, i2cSensors)
#pragma config(I2C_Usage, I2C1, i2cSensors)
#pragma config(Sensor, I2C_1, , sensorQuadEncoderOnI2CPort, , AutoAssign )
#pragma config(Sensor, I2C_2, , sensorQuadEncoderOnI2CPort, , AutoAssign )
#pragma config(Motor, port1, , tmotorVex393_HBridge, openLoop)
#pragma config(Motor, port2, shoot, tmotorVex393_MC29, openLoop, reversed)
#pragma config(Motor, port3, driveLB, tmotorVex393_MC29, openLoop, reversed, encoderPort, I2C_1)
#pragma config(Motor, port3, driveLB, tmotorVex393_MC29, openLoop, reversed, encoderPort, I2C_2)
#pragma config(Motor, port4, driveLF, tmotorVex393_MC29, openLoop, reversed)
#pragma config(Motor, port5, driveRB, tmotorVex393_MC29, openLoop, reversed, encoderPort, I2C_2)
#pragma config(Motor, port5, driveRB, tmotorVex393_MC29, openLoop, reversed, encoderPort, I2C_1)
#pragma config(Motor, port6, driveRF, tmotorVex393_MC29, openLoop)
#pragma config(Motor, port7, bintake, tmotorVex393_MC29, openLoop, reversed)
#pragma config(Motor, port8, , tmotorVex393_MC29, openLoop)
@@ -37,7 +37,7 @@ void shootBall() {
wait(1.25); // Shooting takes 1.25 seconds.
motor[shoot] = STOP;
}
void clearEnc();
void joystickDrive() {
if(abs(vexRT[Ch3]) > DEADZONE) {
motor[driveLB] = vexRT[Ch3];
@@ -82,9 +82,9 @@ void pre_auton() {
bStopTasksBetweenModes = true;
}
void driveTiles(int numberOfTiles, boolean direction) {
while(direction && numberOfTiles * TILE > nMotorEncoder[1]) [
void driveTiles(int numberOfTiles, bool direction) {
clearEnc();
while(direction && numberOfTiles * TILE > nMotorEncoder[1]) {
if(abs(nMotorEncoder[1]) - 10 > nMotorEncoder[2]) {
motor[driveLB] = 100;
motor[driveLF] = 100;
@@ -103,7 +103,7 @@ void driveTiles(int numberOfTiles, boolean direction) {
motor[driveRF] = 100;
}
}
while(!direction && numberOfTiles * TILE > nMotorEncoder[1]) [
while(!direction && numberOfTiles * TILE > nMotorEncoder[1]) {
if(abs(nMotorEncoder[1]) - 10 > nMotorEncoder[2]) {
motor[driveLB] = -100;
motor[driveLF] = -100;
@@ -122,6 +122,10 @@ void driveTiles(int numberOfTiles, boolean direction) {
motor[driveRF] = -100;
}
}
motor[driveLB] = 0;
motor[driveLF] = 0;
motor[driveRB] = 0;
motor[driveRF] = 0;
}
task autonomous() {
shootBall();
@@ -129,10 +133,14 @@ task autonomous() {
//driveTiles(1, false);
}
void turnRight(int turns) {
while(turns * 360 < nMotorEncoder[1]
while(turns * 360 < nMotorEncoder[1]){
}
}
void turnLeft(int turns) {
while(turns * 360 < nMotorEncoder[1]){
}
}
void clearEnc() {