linse/sicspsi
0
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

- Adapted indenation to new agreed upon system

Browse Source 
- Fixed bad status in poldi zug driver
This commit is contained in:
koennecke
2009-02-13 09:01:03 +00:00
parent 6c7bb14fad
commit eb72d5c486
151 changed files with 38234 additions and 38208 deletions
Download Patch File Download Diff File Expand all files Collapse all files

129
julprot.c
View File

@ -14,70 +14,75 @@
#include <ascon.i>
#include <dynstring.h>
static int calculateJulCheckSum(char *realCommand){
int i, checkSum = 0;
for(i = 1; i < strlen(realCommand); i++){
checkSum += (int)realCommand[i];
}
return checkSum;
static int calculateJulCheckSum(char *realCommand)
{
int i, checkSum = 0;
for (i = 1; i < strlen(realCommand); i++) {
checkSum += (int) realCommand[i];
}
return checkSum;
}
/*---------------------------------------------------------------------------*/
int JulchoHandler(Ascon *a){
char *data = NULL;
int checkSum, ret;
char checkBuffer[30], chr;
switch(a->state){
case AsconWriteStart:
data = GetCharArray(a->wrBuffer);
checkSum = calculateJulCheckSum(data);
snprintf(checkBuffer,30,"{%d}$", checkSum);
DynStringConcat(a->wrBuffer,checkBuffer);
a->state = AsconWriting;
a->wrPos = 0;
break;
case AsconReading:
ret = AsconReadChar(a->fd, &chr);
if(ret < 0){
/* EINTR means we must retry */
if(errno != EINTR && errno != EAGAIN){
AsconError(a, "AsconReadChar failed:", errno);
}
return 1;
} else if (ret > 0) {
a->start = DoubleTime();
if(chr == '$'){
DynStringConcatChar(a->rdBuffer, '\0');
a->state = AsconReadDone;
break;
} else {
if (DynStringConcatChar(a->rdBuffer, chr) == 0) {
AsconError(a, "DynStringConcatChar failed:", ENOMEM);
break;
}
}
} else if(ret == 0){
if (a->timeout > 0) {
if (DoubleTime() - a->start > a->timeout) {
AsconError(a, "read timeout", 0);
a->state = AsconTimeout;
}
}
}
break;
default:
return AsconStdHandler(a);
}
return 1;
int JulchoHandler(Ascon * a)
{
char *data = NULL;
int checkSum, ret;
char checkBuffer[30], chr;
switch (a->state) {
case AsconWriteStart:
data = GetCharArray(a->wrBuffer);
checkSum = calculateJulCheckSum(data);
snprintf(checkBuffer, 30, "{%d}$", checkSum);
DynStringConcat(a->wrBuffer, checkBuffer);
a->state = AsconWriting;
a->wrPos = 0;
break;
case AsconReading:
ret = AsconReadChar(a->fd, &chr);
if (ret < 0) {
/* EINTR means we must retry */
if (errno != EINTR && errno != EAGAIN) {
AsconError(a, "AsconReadChar failed:", errno);
}
return 1;
} else if (ret > 0) {
a->start = DoubleTime();
if (chr == '$') {
DynStringConcatChar(a->rdBuffer, '\0');
a->state = AsconReadDone;
break;
} else {
if (DynStringConcatChar(a->rdBuffer, chr) == 0) {
AsconError(a, "DynStringConcatChar failed:", ENOMEM);
break;
}
}
} else if (ret == 0) {
if (a->timeout > 0) {
if (DoubleTime() - a->start > a->timeout) {
AsconError(a, "read timeout", 0);
a->state = AsconTimeout;
}
}
}
break;
default:
return AsconStdHandler(a);
}
return 1;
}
/*-------------------------------------------------------------------------*/
void AddJulChoProtocoll(){
AsconProtocol *prot = NULL;
prot = calloc(sizeof(AsconProtocol), 1);
prot->name = strdup("julcho");
prot->init = AsconStdInit;
prot->handler = JulchoHandler;
AsconInsertProtocol(prot);
void AddJulChoProtocoll()
{
AsconProtocol *prot = NULL;
prot = calloc(sizeof(AsconProtocol), 1);
prot->name = strdup("julcho");
prot->init = AsconStdInit;
prot->handler = JulchoHandler;
AsconInsertProtocol(prot);
}