Advertisement
Guest User

Untitled

a guest
May 26th, 2019
97
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 2.16 KB | None | 0 0
  1. void buttonHandle(void) {
  2.     if (get_button(BUTTON) == GPIO_PIN_RESET) {
  3.         if (chargedLEDS == 6) { // pārbauda vai visi led deg
  4.             if (latDir != ',') {
  5.                 if (zona_anounced == 0) || (zona_anounced != zona) {
  6.                     switch(zona) {
  7.                         case 6:
  8.                             // Play "Kā ziemeļpolā"
  9.                             break;
  10.                         case 5:
  11.                             // Play "Auksts"
  12.                             break;
  13.                         case 4:
  14.                             // Play "Silts"
  15.                             break;
  16.                         case 3:
  17.                             // Play "Pavisam silts"
  18.                             break;
  19.                         case 2:
  20.                             // Play "Karsts"
  21.                             break;
  22.                         case 1:
  23.                             // Play "Deg"
  24.                             break;
  25.                         default:
  26.                             // Not posible
  27.                     }
  28.                     lastdist = curdist;
  29.                     chargedLEDS = 0;
  30.                 }
  31.             } else {
  32.                 // Play "Nav signāla"
  33.             }
  34.             latDir = ',';
  35.         }
  36.         while (get_button(BUTTON) == GPIO_PIN_RESET) {}
  37.         HAL_Delay(70);
  38.         return;
  39.     }
  40. }
  41.  
  42. int main(void) {
  43.     HAL_Init();
  44.     SystemInit();
  45.     SystemClock_Config();
  46.     cstm_f1_uart2_init(9600);
  47.     initPC13();
  48.     button_init();
  49.     while(1) {
  50.         if (cstm_uart2_data_available()) {
  51.             cstm_uart2_receive_data(myBuff, GPS_CHUNK_SIZE, 10);
  52.             decodeGPS(myBuff);
  53.             if (latDir != ',') {    // Looks like we have lock and valid GPS data!
  54.                 curdist = distance(lat, lon);
  55.                 if (curdist > 100) zona = 6
  56.                     else if (curdist <= 100) zona = 5
  57.                         else if (curdist <= 50) zona = 4
  58.                             else if (curdist <= 25) zona = 3
  59.                                 else if (curdist <= 15) zona = 2
  60.                                     else if (curdist <= 5) zona = 1;
  61.                 HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_13);
  62.             }
  63.         }
  64.         buttonHandle();
  65.     }
  66. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement