summaryrefslogtreecommitdiff
path: root/robot/movement.c
diff options
context:
space:
mode:
Diffstat (limited to 'robot/movement.c')
-rw-r--r--robot/movement.c67
1 files changed, 33 insertions, 34 deletions
diff --git a/robot/movement.c b/robot/movement.c
index 82829c1..61a944b 100644
--- a/robot/movement.c
+++ b/robot/movement.c
@@ -1,60 +1,59 @@
-#include "orangutan_shim.h"
#include "movement.h"
+#include "orangutan_shim.h"
-unsigned int g_w2_sensors[5] = {0};
-unsigned int g_w2_position = 0;
+unsigned int g_w2_sensors[5] = {0};
+unsigned int g_w2_position = 0;
-void w2_maze_rotation_full(){
- set_motors(0,0);
+void w2_maze_rotation_full() {
+ set_motors(0, 0);
delay_ms(500);
- set_motors(60,-60);
+ set_motors(60, -60);
delay_ms(540);
- set_motors(0,0);
- g_w2_position = read_line(g_w2_sensors,IR_EMITTERS_ON);
+ set_motors(0, 0);
+ g_w2_position = read_line(g_w2_sensors, IR_EMITTERS_ON);
delay_ms(500);
}
-void w2_maze_rotation_half_left(){
- set_motors(0,0);
- set_motors(50,50);
+void w2_maze_rotation_half_left() {
+ set_motors(0, 0);
+ set_motors(50, 50);
delay_ms(150);
- set_motors(-30,30);
+ set_motors(-30, 30);
delay_ms(600);
- set_motors(0,0);
- g_w2_position = read_line(g_w2_sensors,IR_EMITTERS_ON);
+ set_motors(0, 0);
+ g_w2_position = read_line(g_w2_sensors, IR_EMITTERS_ON);
delay_ms(500);
-
}
-void w2_maze_rotation_half_right(){
- set_motors(0,0);
- set_motors(50,50);
+void w2_maze_rotation_half_right() {
+ set_motors(0, 0);
+ set_motors(50, 50);
delay_ms(150);
- set_motors(30,-30);
+ set_motors(30, -30);
delay_ms(600);
- set_motors(0,0);
- set_motors(50,50);
+ set_motors(0, 0);
+ set_motors(50, 50);
delay_ms(150);
- g_w2_position = read_line(g_w2_sensors,IR_EMITTERS_ON);
+ g_w2_position = read_line(g_w2_sensors, IR_EMITTERS_ON);
delay_ms(500);
}
-void w2_grid_rotation_full(){
- set_motors(60,-60);
+void w2_grid_rotation_full() {
+ set_motors(60, -60);
delay_ms(540);
- set_motors(10,10);
- g_w2_position = read_line(g_w2_sensors,IR_EMITTERS_ON);
+ set_motors(10, 10);
+ g_w2_position = read_line(g_w2_sensors, IR_EMITTERS_ON);
}
-void w2_grid_rotation_half_left(){
- set_motors(-30,30);
+void w2_grid_rotation_half_left() {
+ set_motors(-30, 30);
delay_ms(600);
- set_motors(10,10);
- g_w2_position = read_line(g_w2_sensors,IR_EMITTERS_ON);
+ set_motors(10, 10);
+ g_w2_position = read_line(g_w2_sensors, IR_EMITTERS_ON);
}
-void w2_grid_rotation_half_right(){
- set_motors(30,-30);
+void w2_grid_rotation_half_right() {
+ set_motors(30, -30);
delay_ms(600);
- set_motors(10,10);
- g_w2_position = read_line(g_w2_sensors,IR_EMITTERS_ON);
+ set_motors(10, 10);
+ g_w2_position = read_line(g_w2_sensors, IR_EMITTERS_ON);
}