Zählt "Moves" und Beepers

Dependencies:   mbed ur_Bertl

Meine Projekte

Text
fff
Task_if: Code


  1. a
  2. b
    1. b.1
Committer:
Prettner67
Date:
Thu May 07 12:13:42 2015 +0000
Revision:
1:7d54ee7806ed
Parent:
0:3a81205181c5
Child:
3:bd72c5d54747
Z?hlt Moves und Beepers

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Prettner67 0:3a81205181c5 1 #include "main.h"
Prettner67 0:3a81205181c5 2 #include "const.h"
Prettner67 0:3a81205181c5 3
Prettner67 0:3a81205181c5 4
Prettner67 1:7d54ee7806ed 5 void Task_Bertl :: LineFollow()
Prettner67 0:3a81205181c5 6 {
Prettner67 1:7d54ee7806ed 7 while(1)
Prettner67 0:3a81205181c5 8 {
Prettner67 1:7d54ee7806ed 9 uint8_t val = GetLineValues();
Prettner67 1:7d54ee7806ed 10 NibbleLeds(val);
Prettner67 1:7d54ee7806ed 11
Prettner67 1:7d54ee7806ed 12 if (val == 6)
Prettner67 1:7d54ee7806ed 13 {
Prettner67 1:7d54ee7806ed 14 Move();
Prettner67 1:7d54ee7806ed 15 }
Prettner67 1:7d54ee7806ed 16 if ((val == 1) || (val == 3) || (val == 7))
Prettner67 1:7d54ee7806ed 17 {
Prettner67 1:7d54ee7806ed 18 TurnLeftStep(1);
Prettner67 1:7d54ee7806ed 19 }
Prettner67 1:7d54ee7806ed 20 if ((val == 8) || (val == 12) || (val == 14))
Prettner67 1:7d54ee7806ed 21 {
Prettner67 1:7d54ee7806ed 22 TurnRigthStep(1);
Prettner67 1:7d54ee7806ed 23 }
Prettner67 1:7d54ee7806ed 24 if (val == 0)
Prettner67 1:7d54ee7806ed 25 {
Prettner67 1:7d54ee7806ed 26 break;
Prettner67 1:7d54ee7806ed 27 }
Prettner67 1:7d54ee7806ed 28
Prettner67 1:7d54ee7806ed 29 /*
Prettner67 1:7d54ee7806ed 30 if (val == 9)
Prettner67 1:7d54ee7806ed 31 {
Prettner67 1:7d54ee7806ed 32 Move();
Prettner67 1:7d54ee7806ed 33 }
Prettner67 1:7d54ee7806ed 34 if ((val == 14) || (val == 12) || (val == 8) || (val == 13))
Prettner67 1:7d54ee7806ed 35 {
Prettner67 1:7d54ee7806ed 36 TurnLeftStep(1);
Prettner67 1:7d54ee7806ed 37 }
Prettner67 1:7d54ee7806ed 38 if ((val == 7) || (val == 3) || (val == 1))
Prettner67 1:7d54ee7806ed 39 {
Prettner67 1:7d54ee7806ed 40 TurnRigthStep(1);
Prettner67 1:7d54ee7806ed 41 }
Prettner67 1:7d54ee7806ed 42 if (val == 15)
Prettner67 1:7d54ee7806ed 43 {
Prettner67 1:7d54ee7806ed 44 break;
Prettner67 1:7d54ee7806ed 45 }
Prettner67 1:7d54ee7806ed 46 */
Prettner67 1:7d54ee7806ed 47 }
Prettner67 0:3a81205181c5 48 }
Prettner67 0:3a81205181c5 49
Prettner67 1:7d54ee7806ed 50 void Task_Bertl :: LineSearch()
Prettner67 0:3a81205181c5 51 {
Prettner67 1:7d54ee7806ed 52 uint8_t val = GetLineValues();
Prettner67 1:7d54ee7806ed 53 NibbleLeds(val);
Prettner67 1:7d54ee7806ed 54
Prettner67 1:7d54ee7806ed 55 while(val != 9)
Prettner67 0:3a81205181c5 56 {
Prettner67 0:3a81205181c5 57
Prettner67 1:7d54ee7806ed 58 uint8_t val = GetLineValues();
Prettner67 1:7d54ee7806ed 59 NibbleLeds(val);
Prettner67 1:7d54ee7806ed 60
Prettner67 1:7d54ee7806ed 61 TurnLeftStep(1);
Prettner67 1:7d54ee7806ed 62 if (val == 9)
Prettner67 0:3a81205181c5 63 {
Prettner67 1:7d54ee7806ed 64 break;
Prettner67 0:3a81205181c5 65 }
Prettner67 1:7d54ee7806ed 66
Prettner67 0:3a81205181c5 67 }
Prettner67 0:3a81205181c5 68 }