/home/mrazik/Documents/web/old/hdo/hdo.c

Zobrazit dokumentaci tohoto souboru.

#include <stdio.h>
#include "hdo.h"
/*static*/ struct hdo_data hdo;   

inline void hdo_set_status (enum stat st) {
  hdo.counter = 0;
  hdo.suma    = 0;
  hdo.status  = st;
}
int tlg_write (int avg, char* ptr) {
  char c;

  if (hdo.tindex >= 44) {   // Konec telegramu
    ptr [hdo.windex] = 0;
    hdo.tindex       = 0;
    hdo.windex       = 0;
    hdo_set_status (WAIT_FOR_BEGIN);
    return 1;
  }
  // Doplním písmenka
  if (hdo.tindex == 0)  ptr [hdo.windex++] = 'A';
  if (hdo.tindex == 4)  ptr [hdo.windex++] = 'B';
  if (hdo.tindex == 12) {
    ptr [hdo.windex++] = ' ';
    ptr [hdo.windex++] = 'D';
    ptr [hdo.windex++] = 'P';
    ptr [hdo.windex++] = ':';
  }
  // Skupina A
  if (hdo.tindex < 4) {
    if (avg) c = '1' + hdo.tindex;
    else     c = '-';
    ptr [hdo.windex++] = c;
  }
  // Skupina B
  else if (hdo.tindex < 12) {
    if (avg) c = '1' + hdo.tindex - 4;
    else     c = '-';
    ptr [hdo.windex++] = c;
  }
  // Dvojpovel
  else {
    // skupiny po 4 oddělit mezerami pro lepší čitelnost
    if (!((hdo.tindex+4) % 8)) ptr [hdo.windex++] = ' ';
    if (hdo.tindex % 2) {               // bit "vypnuto" na tindex - to až následně
      if (ptr [hdo.windex] == '-') {         // zapnuto nebylo
        if (avg) ptr [hdo.windex] = 'V';     // tedy je vypnuto
      }
      else {                                 // bylo zapnuto
        if (avg) ptr [hdo.windex] = 'E';     // tedy je chyba - nemůže být obojí
      }
      hdo.windex++;
    }
    else {                              // bit "zapnuto" na tindex - to je první !!!
      if (avg) ptr [hdo.windex] = 'Z';       // je zapnuto
      else     ptr [hdo.windex] = '-';       // ještě se uvidí
    }
  }
  hdo.tindex++;
  hdo_set_status (SPACE1);
  return 0;
}

int tlg_decode (int num, char* str) {
  int on_off, rv = 0;
  switch (hdo.status) {
    case WAIT_FOR_BEGIN:
      hdo.tindex = 0;
      hdo.windex = 0;
      // start telegramu
      if (num > hdo.triger) hdo.status = SYNC_PULSE;
      break;
    case SYNC_PULSE:
      hdo.counter++;
      if (hdo.counter == SYNC_HI) hdo_set_status  (SYNC_SPACE);
      else if (num < hdo.triger)  hdo.status = SYNC_PULSE_DROP;
      break;
    case SYNC_PULSE_DROP:
      hdo.counter++;
      if (hdo.counter == SYNC_HI) hdo_set_status  (SYNC_SPACE);
      else if (num > hdo.triger) hdo.status = SYNC_PULSE;
      else {
        // chyba startovacího pulsu
        if (hdo.counter > DATA_HI) {  // pro krátký puls ignoruj
          rv = -1;
          sprintf (str, "Chyba startovaciho pulsu");
        }
        hdo.status = WAIT_FOR_BEGIN;
      }
      break;
    case SYNC_SPACE:
      hdo.counter++;
      if (hdo.counter == SYNC_LO) hdo_set_status  (DATA_PULSE);
      else if (num > hdo.triger)  hdo.status = SYNC_SPACE_DROP;
      break;
    case SYNC_SPACE_DROP:
      hdo.counter++;
      if (hdo.counter == SYNC_LO) hdo_set_status  (DATA_PULSE);
      else if (num < hdo.triger) hdo.status = SYNC_PULSE;
      else {
          hdo.status = WAIT_FOR_BEGIN;    // chyba synchronizační mezery
          rv = -1;
          sprintf (str, "Chyba synchronizacni mezery");
      }
      break;
    case DATA_PULSE:
      hdo.counter++;
      hdo.suma += num;
      if (hdo.suma > (hdo.counter * hdo.triger)) on_off = 1;
      else                                       on_off = 0;
      if (hdo.counter == DATA_HI) {
        rv = tlg_write (on_off, str);
      }
      break;
    case SPACE1:
      if (num > hdo.triger) hdo.status = SPACE2;
      else                  hdo.status = SPACE3;
      break;
    case SPACE2:
      if (num > hdo.triger) {
        hdo.status = WAIT_FOR_BEGIN;  // chyba mezery mezi daty
        sprintf (str, "Chyba mezery mezi daty");
        rv = -1;
      }
      else hdo.status = SPACE3;
      break;
    case SPACE3:
      hdo.status = DATA_PULSE;
      break;
    default :
      break;
  }
  return rv;
}

int hdo_action (char* tlg, const char* command) {
  int  i, j;
  char c;
  const int index_table [] = {19,20,21,22, 24,25,26,27, 29,30,31,32, 34,35,36,37};
  i = command [1] - '1';              // An
  if ((i < 0) || (i > 3)) return 0;   // chyba
  if (tlg [i+1] == '-')   return 0;   // není pro mne
  i = command [3] - '1';              // Bn
  if ((i < 0) || (i > 7)) return 0;   // chyba
  if (tlg [i+6] == '-')   return 0;   // není pro mne
  i = command [6] - '0';              // DPn
  j = command [7];                    // DPn+1
  if (j) {
    j -= '0';
    i *= 10;
    i += j;
  }                                    // v i je číslo za DP
  if ((i < 1) || (i > 16)) return 0;   // chyba
  i--;                                 // index bude o 1 menší
  j = index_table [i];                 // v telegramu na pozici j
  c = tlg [j];                         // je písmeno
  if (c == 'Z') return +1;             // Z - potom zapni
  if (c == 'V') return -1;             // V - vypni
  return 0;
}

void hdo_init (int tv) {
  hdo.windex  = 0;
  hdo.tindex  = 0;
  hdo.counter = 0;
  hdo.suma    = 0;
  hdo.triger  = tv;
  hdo.status  = WAIT_FOR_BEGIN;
}