From 31844e1e0ac81c729d4007f6fe4ff6e79f3f298e Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Thu, 14 Apr 2016 11:43:47 -0400 Subject: [PATCH 01/16] Create pseudo code --- pseudo code | 29 +++++++++++++++++++++++++++++ 1 file changed, 29 insertions(+) create mode 100644 pseudo code diff --git a/pseudo code b/pseudo code new file mode 100644 index 0000000..533248c --- /dev/null +++ b/pseudo code @@ -0,0 +1,29 @@ +// Motor and Sensor Setup + +task main() +{ + while(true) + { + while(getBumberValue() == ) + { + if(getDistanceValue() < ) + } + forward(); + } + else + { + backward(); + } + } + } +} + + +getColor…() +getGyroValue() +getLEDValue() +setMultipleMotor() +turnLeft() +turnRight() +stopAllMotors() + From 8cd4a1346dd25b929ae8475b82ae2a675a13f0a7 Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Thu, 14 Apr 2016 11:59:58 -0400 Subject: [PATCH 02/16] Update pseudo code --- pseudo code | 20 ++++++++++---------- 1 file changed, 10 insertions(+), 10 deletions(-) diff --git a/pseudo code b/pseudo code index 533248c..f038970 100644 --- a/pseudo code +++ b/pseudo code @@ -2,19 +2,19 @@ task main() { - while(true) + while(true) { - while(getBumberValue() == ) + while(getBumberValue() == ) + { + if(getDistanceValue() < ) { - if(getDistanceValue() < ) - } - forward(); - } - else - { - backward(); - } + forward(); } + else + { + backward(); + } + } } } From 5477d1f1e47ff0d34ccf01ea63f0db3c47ceba4c Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Fri, 15 Apr 2016 13:21:33 -0400 Subject: [PATCH 03/16] Update pseudo code --- pseudo code | 2 ++ 1 file changed, 2 insertions(+) diff --git a/pseudo code b/pseudo code index f038970..d0921af 100644 --- a/pseudo code +++ b/pseudo code @@ -26,4 +26,6 @@ setMultipleMotor() turnLeft() turnRight() stopAllMotors() +setMotor() + From 54597d139517585fb7a281b3a82e4e4f1a697ee9 Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Sun, 17 Apr 2016 13:54:09 -0400 Subject: [PATCH 04/16] Update pseudo code --- pseudo code | 67 ++++++++++++++++++++++++++++++++++++++--------------- 1 file changed, 48 insertions(+), 19 deletions(-) diff --git a/pseudo code b/pseudo code index d0921af..0ae6404 100644 --- a/pseudo code +++ b/pseudo code @@ -1,31 +1,60 @@ -// Motor and Sensor Setup +#pragma config(Sensor, port3, colour, sensorVexIQ_Color12Color) +#pragma config(Sensor, port8, bumper, sensorVexIQ_Touch) +#pragma config(Motor, motor1, left, tmotorVexIQ, PIDControl, driveLeft, encoder) +#pragma config(Motor, motor6, right, tmotorVexIQ, PIDControl, reversed, driveRight, encoder) +#pragma config(Motor, motor10, lift, tmotorVexIQ, PIDControl, encoder) +#pragma config(Motor, motor11, claw, tmotorVexIQ, PIDControl, encoder) +//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*// task main() { - while(true) + int i = 0; + while(i != 4) { - while(getBumberValue() == ) + setMultipleMotors(50, left, right); + while(getColorName(colour) == colorRed) { - if(getDistanceValue() < ) + forward(180, degrees, 50); + moveMotor(claw, 90, degrees, 50); + turnLeft(275, degrees, 50); + moveMotor(lift, 360, degrees, 100); + forward(360, degrees, 50); + moveMotor(lift, -360, degrees, 100); + moveMotor(claw, 90, degrees, -50); + backward(360, degrees, -50); + turnRight(275, degrees, 50); + i++; + while(getBumperValue(bumper) == 0) { - forward(); + setMultipleMotors(-100, left, right); } - else + while(getBumperValue(bumper) == 1) { - backward(); + setMultipleMotors(100,left, right); + } + } + while(getColorName(colour) == colorGreen) + { + forward(180, degrees, 50); + moveMotor(claw, 90, degrees, 50); + turnRight(275, degrees, 50); + moveMotor(lift, 360, degrees, 100); + forward(360, degrees, 50); + moveMotor(lift, -360, degrees, 100); + moveMotor(claw, 90, degrees, -50); + backward(360, degrees, -50); + turnLeft(275, degrees, 50); + i++; + while(getBumperValue(bumper) == 0) + { + setMultipleMotors(-100, left, right); + } + while(getBumperValue(bumper) == 1) + { + setMultipleMotors(100,left, right); } } - } -} - - -getColor…() -getGyroValue() -getLEDValue() -setMultipleMotor() -turnLeft() -turnRight() -stopAllMotors() -setMotor() + } +} From 04415da8304fd04e475543034ff7804f9e39caf1 Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Sun, 17 Apr 2016 13:55:28 -0400 Subject: [PATCH 05/16] Create code --- code | 52 ++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 52 insertions(+) create mode 100644 code diff --git a/code b/code new file mode 100644 index 0000000..beb1d30 --- /dev/null +++ b/code @@ -0,0 +1,52 @@ +#pragma config(Sensor, port2, gyro_sensor, sensorVexIQ_Gyro) +#pragma config(Sensor, port3, bumper_sensor, sensorVexIQ_Touch) +#pragma config(Sensor, port4, colour_sensor, sensorVexIQ_Color12Color) +#pragma config(Sensor, port5, distance_sensor, sensorVexIQ_Distance) +#pragma config(Sensor, port7, touch_led, sensorVexIQ_LED) +#pragma config(Motor, motor1, left_motor, tmotorVexIQ, PIDControl, driveLeft, encoder) +#pragma config(Motor, motor6, right_motor, tmotorVexIQ, PIDControl, reversed, driveRight, encoder) +//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*// + +task main() +{ + bool finish = true; + while (finish) + { + if (getTouchLEDValue(touch_led) == 1) + { + while (getTouchLEDValue(touch_led) == 0) + { + setMultipleMotors(75, left_motor, right_motor); + if (getColorName(colour_sensor) == colorRed) + { + finish = false; + } + if (getBumperValue(bumper_sensor) == 1) + { + if (getDistanceValue(distance_sensor) < 350) + { + backward(90,degrees, 50); + resetGyro(gyro_sensor); + while (getGyroDegrees(gyro_sensor) < 80) + { + setMotor(left_motor, -50); + setMotor(right_motor, 50); + } + stopAllMotors(); + } + else + { + backward(90,degrees, 50); + resetGyro(gyro_sensor); + while(getGyroDegrees(gyro_sensor) > -80) + { + setMotor(left_motor, 50); + setMotor(right_motor, -50); + } + stopAllMotors(); + } + } + } + } + } +} From 69966a3d8b8757db7b436325d797ca9597e7072f Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Sun, 17 Apr 2016 14:01:11 -0400 Subject: [PATCH 06/16] Update pseudo code --- pseudo code | 8 ++++---- 1 file changed, 4 insertions(+), 4 deletions(-) diff --git a/pseudo code b/pseudo code index 0ae6404..6e16914 100644 --- a/pseudo code +++ b/pseudo code @@ -17,9 +17,9 @@ task main() forward(180, degrees, 50); moveMotor(claw, 90, degrees, 50); turnLeft(275, degrees, 50); - moveMotor(lift, 360, degrees, 100); + moveMotor(lift, 3, rotations, 100); forward(360, degrees, 50); - moveMotor(lift, -360, degrees, 100); + moveMotor(lift, 3, rotations, -100); moveMotor(claw, 90, degrees, -50); backward(360, degrees, -50); turnRight(275, degrees, 50); @@ -38,9 +38,9 @@ task main() forward(180, degrees, 50); moveMotor(claw, 90, degrees, 50); turnRight(275, degrees, 50); - moveMotor(lift, 360, degrees, 100); + moveMotor(lift, 3, rotations, 100); forward(360, degrees, 50); - moveMotor(lift, -360, degrees, 100); + moveMotor(lift, 3, rotations, -100); moveMotor(claw, 90, degrees, -50); backward(360, degrees, -50); turnLeft(275, degrees, 50); From 114311664ff399bff0633aae17b6ce83ce94319f Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Sun, 29 May 2016 13:51:16 -0400 Subject: [PATCH 07/16] Create stack_fail --- stack_fail | 52 ++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 52 insertions(+) create mode 100644 stack_fail diff --git a/stack_fail b/stack_fail new file mode 100644 index 0000000..3e0f754 --- /dev/null +++ b/stack_fail @@ -0,0 +1,52 @@ +#pragma config(Sensor, port2, bumper, sensorVexIQ_Touch) +#pragma config(Sensor, port3, colour, sensorVexIQ_Color12Color) +#pragma config(Motor, motor1, left, tmotorVexIQ, PIDControl, driveLeft, encoder) +#pragma config(Motor, motor6, right, tmotorVexIQ, PIDControl, reversed, driveRight, encoder) +#pragma config(Motor, motor10, lift, tmotorVexIQ, PIDControl, encoder) +#pragma config(Motor, motor11, claw, tmotorVexIQ, PIDControl, encoder) +//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*// + +task main() +{ + int count = 0; + while(count != 3) + { + setMultipleMotors(50, left, right); + while(count == 0) + { + while((getColorName(colour) == colorGreen)||(getColorName(colour) == colorRed)) + { + forward(180, degrees, 50); + moveMotor(claw, 90, degrees, 50); + moveMotor(lift, 3, rotations, 50); + moveMotor(claw, 90, degrees, -50); + moveMotor(lift, 3, rotations, -50); + count+=1; + } + } + while(count == 1) + { + setMultipleMotors(50, left, right); + while((getColorName(colour) == colorGreen)||(getColorName(colour) == colorRed)) + { + forward(180, degrees, 50); + moveMotor(claw, 90, degrees, 50); + moveMotor(lift, 2, rotations, 50); + count+=1; + } + } + while(count == 2) + { + setMultipleMotors(50, left, right); + if(getBumperValue(bumper) == 1) + { + moveMotor(lift, 1, rotations, -50); + moveMotor(claw, 90, degrees, -50); + moveMotor(lift, 2, rotations, 50); + moveMotor(claw, 90, degrees, 50); + moveMotor(lift, 3, rotations, -100); + count+=1; + } + } + } +} From f3ee615835473d0a9ce79a009991f5c57805f69c Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Sun, 29 May 2016 13:52:02 -0400 Subject: [PATCH 08/16] Create mazerunner --- mazerunner | 52 ++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 52 insertions(+) create mode 100644 mazerunner diff --git a/mazerunner b/mazerunner new file mode 100644 index 0000000..beb1d30 --- /dev/null +++ b/mazerunner @@ -0,0 +1,52 @@ +#pragma config(Sensor, port2, gyro_sensor, sensorVexIQ_Gyro) +#pragma config(Sensor, port3, bumper_sensor, sensorVexIQ_Touch) +#pragma config(Sensor, port4, colour_sensor, sensorVexIQ_Color12Color) +#pragma config(Sensor, port5, distance_sensor, sensorVexIQ_Distance) +#pragma config(Sensor, port7, touch_led, sensorVexIQ_LED) +#pragma config(Motor, motor1, left_motor, tmotorVexIQ, PIDControl, driveLeft, encoder) +#pragma config(Motor, motor6, right_motor, tmotorVexIQ, PIDControl, reversed, driveRight, encoder) +//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*// + +task main() +{ + bool finish = true; + while (finish) + { + if (getTouchLEDValue(touch_led) == 1) + { + while (getTouchLEDValue(touch_led) == 0) + { + setMultipleMotors(75, left_motor, right_motor); + if (getColorName(colour_sensor) == colorRed) + { + finish = false; + } + if (getBumperValue(bumper_sensor) == 1) + { + if (getDistanceValue(distance_sensor) < 350) + { + backward(90,degrees, 50); + resetGyro(gyro_sensor); + while (getGyroDegrees(gyro_sensor) < 80) + { + setMotor(left_motor, -50); + setMotor(right_motor, 50); + } + stopAllMotors(); + } + else + { + backward(90,degrees, 50); + resetGyro(gyro_sensor); + while(getGyroDegrees(gyro_sensor) > -80) + { + setMotor(left_motor, 50); + setMotor(right_motor, -50); + } + stopAllMotors(); + } + } + } + } + } +} From 94a898b67b6efbafbd5e4658446507efbf1a00e8 Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Sun, 29 May 2016 13:53:03 -0400 Subject: [PATCH 09/16] Create Distance Slow Down --- Distance Slow Down | 43 +++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 43 insertions(+) create mode 100644 Distance Slow Down diff --git a/Distance Slow Down b/Distance Slow Down new file mode 100644 index 0000000..fc3995b --- /dev/null +++ b/Distance Slow Down @@ -0,0 +1,43 @@ +#pragma config(Sensor, port3, bumper, sensorVexIQ_Touch) +#pragma config(Sensor, port4, distance, sensorVexIQ_Distance) +#pragma config(Sensor, port10, colour, sensorVexIQ_LED) +#pragma config(Motor, motor1, left, tmotorVexIQ, PIDControl, driveLeft, encoder) +#pragma config(Motor, motor6, right, tmotorVexIQ, PIDControl, reversed, driveRight, encoder) +//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*// + +task main() +{ + while(true) + { + setMultipleMotors(100, left, right); + + while (getDistanceValue(distance) <= 400 && getDistanceValue(distance) > 300) + { + setMultipleMotors(50, left, right); + setTouchLEDColor(colour, colorRed); + } + + while (getDistanceValue(distance) <= 300 && getDistanceValue(distance) > 200) + { + setMultipleMotors(40, left, right); + setTouchLEDColor(colour, colorBlue); + } + + while (getDistanceValue(distance) <= 200 && getDistanceValue(distance) > 100) + { + setMultipleMotors(20, left, right); + setTouchLEDColor(colour, colorGreen); + } + while (getDistanceValue(distance) <= 100 && getDistanceValue(distance) > 50) + { + setMultipleMotors(10, left, right); + if (getBumperValue(bumper) == 1) + { + backward(180, degrees, -50); + turnLeft(240, degrees, 100); + setTouchLEDColor(colour, colorYellow); + } + } + + } +} From af05d445e6cc8857a1183bc18b4f18699b5f21fd Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Sun, 29 May 2016 13:53:29 -0400 Subject: [PATCH 10/16] Create stackofficial --- stackofficial | 51 +++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 51 insertions(+) create mode 100644 stackofficial diff --git a/stackofficial b/stackofficial new file mode 100644 index 0000000..8f82aeb --- /dev/null +++ b/stackofficial @@ -0,0 +1,51 @@ +#pragma config(Sensor, port2, bumper, sensorVexIQ_Touch) +#pragma config(Sensor, port3, colour, sensorVexIQ_Color12Color) +#pragma config(Motor, motor1, left, tmotorVexIQ, PIDControl, driveLeft, encoder) +#pragma config(Motor, motor6, right, tmotorVexIQ, PIDControl, reversed, driveRight, encoder) +#pragma config(Motor, motor10, lift, tmotorVexIQ, PIDControl, encoder) +#pragma config(Motor, motor11, claw, tmotorVexIQ, PIDControl, encoder) +//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*// + + +void cubeHolder() +{ + forward(180, degrees, 50); + moveMotor(claw, 90, degrees, 50); + moveMotor(lift, 3, rotations, 50); + moveMotor(claw, 90, degrees, -50); + moveMotor(lift, 3, rotations, -50); +} +void cubePickUp() +{ + forward(180, degrees, 50); + moveMotor(claw, 90, degrees, 50); + moveMotor(lift, 2, rotations, 50); +} +void cubeDrop() +{ + moveMotor(claw, 90, degrees, -50); + moveMotor(lift, 2, rotations, -50); +} +void cubeHolderDrop() +{ + moveMotor(lift, 3, rotations, 50); + moveMotor(claw, 90, degrees, 50); + moveMotor(lift, 3, rotations, -50); + moveMotor(claw, 90, degrees, -50); +} +void cubePushandStack() +{ + while (getBumperValue(bumper) = 1) + { + backward(1, rotations, 50); + cubeDrop(); + cubeHolderDrop() + } +} +void checkCubeColor() +{ + +task main() +{ + +} From 8667a2005f33daa2e71c4345ae479bcc3d35e4b5 Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Sun, 29 May 2016 13:59:16 -0400 Subject: [PATCH 11/16] Update stackofficial --- stackofficial | 12 ++++++++---- 1 file changed, 8 insertions(+), 4 deletions(-) diff --git a/stackofficial b/stackofficial index 8f82aeb..8f1e4d0 100644 --- a/stackofficial +++ b/stackofficial @@ -35,17 +35,21 @@ void cubeHolderDrop() } void cubePushandStack() { - while (getBumperValue(bumper) = 1) + while (getBumperValue(bumper) == 1) { backward(1, rotations, 50); cubeDrop(); - cubeHolderDrop() + cubeHolderDrop(); } } void checkCubeColor() { - +} + task main() { - +cubeHolder(); +cubePickUp(); +cubePushandStack(); +checkCubeColor(); } From 3a4fa385116328489c392fed590ec741af738453 Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Sun, 5 Jun 2016 14:00:44 -0400 Subject: [PATCH 12/16] Update stackofficial --- stackofficial | 50 ++++++++++++++++++++++++++++++++++++++++++-------- 1 file changed, 42 insertions(+), 8 deletions(-) diff --git a/stackofficial b/stackofficial index 8f1e4d0..a27cfdb 100644 --- a/stackofficial +++ b/stackofficial @@ -19,17 +19,17 @@ void cubePickUp() { forward(180, degrees, 50); moveMotor(claw, 90, degrees, 50); - moveMotor(lift, 2, rotations, 50); + moveMotor(lift, 1, rotations, 50); } void cubeDrop() { - moveMotor(claw, 90, degrees, -50); moveMotor(lift, 2, rotations, -50); + moveMotor(claw, 90, degrees, -50); } void cubeHolderDrop() { moveMotor(lift, 3, rotations, 50); - moveMotor(claw, 90, degrees, 50); + moveMotor(claw, 90, degrees, 50); moveMotor(lift, 3, rotations, -50); moveMotor(claw, 90, degrees, -50); } @@ -42,14 +42,48 @@ void cubePushandStack() cubeHolderDrop(); } } + void checkCubeColor() { -} + bool color; + while (color) + { + if (getColorName(colour) == colorGreen) + { + color = false; + } + if (getColorName(colour) == colorRed) + { + color = false; + stopAllMotors(); + } + } +} task main() { -cubeHolder(); -cubePickUp(); -cubePushandStack(); -checkCubeColor(); + int i = 0; + while (i != 3) + { + displayTextLine(1, "hello world"); + setMultipleMotors(50, left, right); + while (i == 0) + { + checkCubeColor(); + cubeHolder(); + i++; + } + while (i == 1) + { + checkCubeColor(); + cubePickUp(); + i++; + } + while (i == 2) + { + cubePushandStack(); + checkCubeColor(); + i++; + } + } } From c29fa8354a9389cd6a31452b38ef01513d333390 Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Sun, 12 Jun 2016 13:13:31 -0400 Subject: [PATCH 13/16] Update stackofficial --- stackofficial | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/stackofficial b/stackofficial index a27cfdb..a1571a0 100644 --- a/stackofficial +++ b/stackofficial @@ -45,7 +45,7 @@ void cubePushandStack() void checkCubeColor() { - bool color; + bool color; while (color) { if (getColorName(colour) == colorGreen) @@ -66,7 +66,7 @@ task main() while (i != 3) { displayTextLine(1, "hello world"); - setMultipleMotors(50, left, right); + setMultipleMotors(50, left, right); while (i == 0) { checkCubeColor(); @@ -84,6 +84,6 @@ task main() cubePushandStack(); checkCubeColor(); i++; - } + } } } From a7a023b720d95d66f2a1869f3e853eb0de5b4a4b Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Sun, 12 Jun 2016 13:14:50 -0400 Subject: [PATCH 14/16] Create Sorting --- Sorting | 33 +++++++++++++++++++++++++++++++++ 1 file changed, 33 insertions(+) create mode 100644 Sorting diff --git a/Sorting b/Sorting new file mode 100644 index 0000000..11b231a --- /dev/null +++ b/Sorting @@ -0,0 +1,33 @@ +#pragma config(Sensor, port3, colour, sensorVexIQ_Color12Color) +#pragma config(Motor, motor1, left, tmotorVexIQ, PIDControl, driveLeft, encoder) +#pragma config(Motor, motor6, right, tmotorVexIQ, PIDControl, reversed, driveRight, encoder) +#pragma config(Motor, motor10, lift, tmotorVexIQ, PIDControl, encoder) +#pragma config(Motor, motor11, claw, tmotorVexIQ, PIDControl, encoder) +//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*// + +task main() +{ + { + setMultipleMotors(50, left, right); + while (getColorName(colour) == colorRed) + { + forward(180, degrees, 50); + moveMotor(claw, 90, degrees, 50); + turnLeft(275, degrees, 50); + forward(360, degrees, 50); + moveMotor(claw, 90, degrees, -50); + backward(360, degrees, -50); + turnRight(275, degrees, 50); + } + while (getColorName(colour) == colorGreen) + { + forward(180, degrees, 50); + moveMotor(claw, 90, degrees, 50); + turnRight(275, degrees, 50); + forward(360, degrees, 50); + moveMotor(claw, 90, degrees, -50); + backward(360, degrees, -50); + turnLeft(275, degrees, 50); + } + } +} From cd2a50f71cd443bb62233932537d16c1c113b8a9 Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Thu, 16 Jun 2016 21:05:25 -0400 Subject: [PATCH 15/16] Update Sorting --- Sorting | 1 + 1 file changed, 1 insertion(+) diff --git a/Sorting b/Sorting index 11b231a..a36c552 100644 --- a/Sorting +++ b/Sorting @@ -7,6 +7,7 @@ task main() { + while (true) { setMultipleMotors(50, left, right); while (getColorName(colour) == colorRed) From 704c311d93472dc7d36226eeadb87933f5245bf9 Mon Sep 17 00:00:00 2001 From: Alan Sivabalan Date: Thu, 16 Jun 2016 21:49:45 -0400 Subject: [PATCH 16/16] Update stackofficial --- stackofficial | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/stackofficial b/stackofficial index a1571a0..3b2bb28 100644 --- a/stackofficial +++ b/stackofficial @@ -82,7 +82,7 @@ task main() while (i == 2) { cubePushandStack(); - checkCubeColor(); + //checkCubeColor(); i++; } }