easel/air.cpp at master · TNCTRobocon/easel · GitHub

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
#include "config.hpp"


void air_up(){
  serialPrintf(srid,"sel 32\r");
  serialPrintf(srid,"close 2 3 4\r");
  serialPrintf(srid,"sel 32\r");
  serialPrintf(srid,"close 5 6\r");
  serialPrintf(srid,"sel 33\r");
  serialPrintf(srid,"close 2 4 6\r");
  serialPrintf(srid,"sel 33\r");
  serialPrintf(srid,"open 1 3 5\r");
  serialPrintf(srid,"sel 32\r");
  serialPrintf(srid,"open 1\r");
  printf("air_up\n");
}

void air_down(){
  serialPrintf(srid,"sel 33\r");
  serialPrintf(srid,"close 1 3 5\r");
  serialPrintf(srid,"sel 33\r");
  serialPrintf(srid,"open 2 4 6\r");
  serialPrintf(srid,"sel 32\r");
  serialPrintf(srid,"close 1 3\r");
  serialPrintf(srid,"sel 32\r");
  serialPrintf(srid,"close 4 5 6\r");
  serialPrintf(srid,"sel 32\r");
  serialPrintf(srid,"open 2\r");
  printf("air_down\n");
}

void air_clear(){
  serialPrintf(srid,"sel 32\r");
  serialPrintf(srid,"clear\r");
  serialPrintf(srid,"sel 33\r");
  serialPrintf(srid,"clear\r");
  printf("air_clear\n");
}