178,7 → 178,7 |
|
|
// -------------------------------------------------------------------------- |
void SendOutData(unsigned char cmd,unsigned char modul, unsigned char BufferAnzahl, ...) //unsigned char *snd, unsigned char len) |
void SendOutData(unsigned char cmd,unsigned char address, unsigned char BufferAnzahl, ...) //unsigned char *snd, unsigned char len) |
{ |
va_list ap; |
unsigned int pt = 0; |
189,7 → 189,7 |
int len = 0; |
|
SendeBuffer[pt++] = '#'; // Startzeichen |
SendeBuffer[pt++] = modul; // Adresse (a=0; b=1,...) |
SendeBuffer[pt++] = 'a' + address; // Adresse (a=0; b=1,...) |
SendeBuffer[pt++] = cmd; // Commando |
|
va_start(ap, BufferAnzahl); |
285,10 → 285,11 |
{ |
if(!NeuerDatensatzEmpfangen) return; |
|
Decode64(); // dekodiere datenblock im Empfangsbuffer |
switch(RxdBuffer[1]-'a') // check for Slave Address |
{ |
case FC_ADDRESS: // FC special commands |
Decode64(); // dekodiere datenblock im Empfangsbuffer |
|
switch(RxdBuffer[2]) |
{ |
case 'K':// Kompasswert |
338,11 → 339,10 |
} |
break; |
|
} |
break; // case FC_ADDRESS: |
} // case FC_ADDRESS: |
|
default: // any Slave Address |
Decode64(); |
|
switch(RxdBuffer[2]) |
{ |
// 't' comand placed here only for compatibility to BL |