summaryrefslogtreecommitdiff
path: root/OLD_CODE_REMOVE_LATER/debug/prewk/IMU_comp/calcoffset/calcoffset.ino
blob: fc5f752f6e8daa271d8d065edaf3061ca54e40f4 (plain)
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
void setup() {
  randomSeed(analogRead(0));
  Serial.begin(9600);

}

void loop() {
  int front = random(0, 360);
  int heading = random(0, 360);
  Serial.print("Front: ");
  Serial.println(front);
  Serial.print("heading: ");
  Serial.println(heading);

  int offset = heading - front;
  if(offset<0){
    offset=(offset+360);
  }
  Serial.print("offset: ");
  Serial.println(offset);
  
  Serial.println();
  Serial.println();

  delay(5000);

}