- Adapted indenation to new agreed upon system
- Fixed bad status in poldi zug driver
This commit is contained in:
koennecke
535
velodorn.c
535
velodorn.c
@@ -56,249 +56,330 @@
|
||||
|
||||
#define TOK_BUF_L 25
|
||||
/*--------------------------- analyse Dornier status string ----------------*/
|
||||
int AnalyseDornierStatus(char *pText, pDornierStatus pResult)
|
||||
{
|
||||
int cnt, key_id, sl, sts;
|
||||
long err;
|
||||
char ena_str[] = "ENABLED";
|
||||
char dis_str[] = "DISABLED";
|
||||
char keys[16][9] =
|
||||
{
|
||||
"Status:\0 ",
|
||||
"S_DREH:\0 ",
|
||||
"I_DREH:\0 ",
|
||||
"P_VERL:\0 ",
|
||||
"STROM:\0 ",
|
||||
"T_ROT:\0 ",
|
||||
"T_GEH:\0 ",
|
||||
"T_VOR:\0 ",
|
||||
"T_RUECK:\0",
|
||||
"DURCHFL:\0",
|
||||
"VAKUUM:\0 ",
|
||||
"BESCHL:\0 ",
|
||||
"KOM: \0 ",
|
||||
"DATE: \0 ",
|
||||
"TIME: \0 ",
|
||||
"Hz:\0 "};
|
||||
int AnalyseDornierStatus(char *pText, pDornierStatus pResult)
|
||||
{
|
||||
int cnt, key_id, sl, sts;
|
||||
long err;
|
||||
char ena_str[] = "ENABLED";
|
||||
char dis_str[] = "DISABLED";
|
||||
char keys[16][9] = {
|
||||
"Status:\0 ",
|
||||
"S_DREH:\0 ",
|
||||
"I_DREH:\0 ",
|
||||
"P_VERL:\0 ",
|
||||
"STROM:\0 ",
|
||||
"T_ROT:\0 ",
|
||||
"T_GEH:\0 ",
|
||||
"T_VOR:\0 ",
|
||||
"T_RUECK:\0",
|
||||
"DURCHFL:\0",
|
||||
"VAKUUM:\0 ",
|
||||
"BESCHL:\0 ",
|
||||
"KOM: \0 ",
|
||||
"DATE: \0 ",
|
||||
"TIME: \0 ",
|
||||
"Hz:\0 "
|
||||
};
|
||||
|
||||
char tok_buf[TOK_BUF_L], *ptr_token, *ptr_src, *ptr;
|
||||
const char tok_c[] = "/\\\0";
|
||||
char status[255];
|
||||
char tok_buf[TOK_BUF_L], *ptr_token, *ptr_src, *ptr;
|
||||
const char tok_c[] = "/\\\0";
|
||||
char status[255];
|
||||
|
||||
ptr_src = pText;
|
||||
memset(pResult,0,sizeof(DornierStatus));
|
||||
ptr_src = pText;
|
||||
memset(pResult, 0, sizeof(DornierStatus));
|
||||
|
||||
/* skip over first token, should be command echo */
|
||||
ptr_token = strtok(ptr_src, tok_c);
|
||||
if (ptr_token == NULL) return 0; /* error */
|
||||
strcpy(pResult->echo,(const char *)ptr_token);
|
||||
ptr_src += strlen(ptr_token);
|
||||
|
||||
ptr_src = NULL; /* necessary for further search with strtok */
|
||||
for (;;)
|
||||
{
|
||||
/* read text till next separator '/' */
|
||||
ptr_token = strtok(ptr_src, tok_c);
|
||||
if (ptr_token == NULL) break;
|
||||
strcpy(tok_buf,ptr_token);
|
||||
/* skip over first token, should be command echo */
|
||||
ptr_token = strtok(ptr_src, tok_c);
|
||||
if (ptr_token == NULL)
|
||||
return 0; /* error */
|
||||
strcpy(pResult->echo, (const char *) ptr_token);
|
||||
ptr_src += strlen(ptr_token);
|
||||
|
||||
for (key_id = 0; key_id<=15; key_id++)
|
||||
{
|
||||
/* search key ? */
|
||||
sl = strlen(keys[key_id]);
|
||||
if (strncmp(&keys[key_id][0], tok_buf, sl) == 0)
|
||||
{
|
||||
/* step over key */
|
||||
for (cnt=0;cnt+sl < TOK_BUF_L; cnt++)
|
||||
tok_buf[cnt] = tok_buf[cnt+sl];
|
||||
switch (key_id)
|
||||
{
|
||||
case 0: {strcpy(pResult->rm, tok_buf); break;}
|
||||
case 1: {sscanf(tok_buf,"%d",&pResult->nom_rpm); break;}
|
||||
case 2: {sscanf(tok_buf,"%d",&pResult->cur_rpm); break;}
|
||||
case 3: {sscanf(tok_buf,"%d",&pResult->pwr); break;}
|
||||
case 4: {sscanf(tok_buf,"%f",&pResult->curr); break;}
|
||||
case 5: {sscanf(tok_buf,"%d",&pResult->rot_temp); break;}
|
||||
case 6: {sscanf(tok_buf,"%d",&pResult->cont_temp); break;}
|
||||
case 7: {sscanf(tok_buf,"%d",&pResult->inl_temp); break;}
|
||||
case 8: {sscanf(tok_buf,"%d",&pResult->outl_temp); break;}
|
||||
case 9: {sscanf(tok_buf,"%f",&pResult->cool_wat); break;}
|
||||
case 10: {sscanf(tok_buf,"%f",&pResult->vacuum); break;}
|
||||
case 11: {sscanf(tok_buf,"%f",&pResult->accel); break;}
|
||||
case 12: {
|
||||
if (strcmp(tok_buf, ena_str) == 0)
|
||||
{pResult->komm = 1; break;}
|
||||
if (strcmp(tok_buf, dis_str) == 0)
|
||||
{pResult->komm = 0;break;}
|
||||
break;
|
||||
}
|
||||
case 13: break; /* date */
|
||||
case 14: break; /* time */
|
||||
case 15: {sscanf(tok_buf,"%d",&pResult->iHz); break;}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
return(1);
|
||||
ptr_src = NULL; /* necessary for further search with strtok */
|
||||
for (;;) {
|
||||
/* read text till next separator '/' */
|
||||
ptr_token = strtok(ptr_src, tok_c);
|
||||
if (ptr_token == NULL)
|
||||
break;
|
||||
strcpy(tok_buf, ptr_token);
|
||||
|
||||
for (key_id = 0; key_id <= 15; key_id++) {
|
||||
/* search key ? */
|
||||
sl = strlen(keys[key_id]);
|
||||
if (strncmp(&keys[key_id][0], tok_buf, sl) == 0) {
|
||||
/* step over key */
|
||||
for (cnt = 0; cnt + sl < TOK_BUF_L; cnt++)
|
||||
tok_buf[cnt] = tok_buf[cnt + sl];
|
||||
switch (key_id) {
|
||||
case 0:{
|
||||
strcpy(pResult->rm, tok_buf);
|
||||
break;
|
||||
}
|
||||
case 1:{
|
||||
sscanf(tok_buf, "%d", &pResult->nom_rpm);
|
||||
break;
|
||||
}
|
||||
case 2:{
|
||||
sscanf(tok_buf, "%d", &pResult->cur_rpm);
|
||||
break;
|
||||
}
|
||||
case 3:{
|
||||
sscanf(tok_buf, "%d", &pResult->pwr);
|
||||
break;
|
||||
}
|
||||
case 4:{
|
||||
sscanf(tok_buf, "%f", &pResult->curr);
|
||||
break;
|
||||
}
|
||||
case 5:{
|
||||
sscanf(tok_buf, "%d", &pResult->rot_temp);
|
||||
break;
|
||||
}
|
||||
case 6:{
|
||||
sscanf(tok_buf, "%d", &pResult->cont_temp);
|
||||
break;
|
||||
}
|
||||
case 7:{
|
||||
sscanf(tok_buf, "%d", &pResult->inl_temp);
|
||||
break;
|
||||
}
|
||||
case 8:{
|
||||
sscanf(tok_buf, "%d", &pResult->outl_temp);
|
||||
break;
|
||||
}
|
||||
case 9:{
|
||||
sscanf(tok_buf, "%f", &pResult->cool_wat);
|
||||
break;
|
||||
}
|
||||
case 10:{
|
||||
sscanf(tok_buf, "%f", &pResult->vacuum);
|
||||
break;
|
||||
}
|
||||
case 11:{
|
||||
sscanf(tok_buf, "%f", &pResult->accel);
|
||||
break;
|
||||
}
|
||||
case 12:{
|
||||
if (strcmp(tok_buf, ena_str) == 0) {
|
||||
pResult->komm = 1;
|
||||
break;
|
||||
}
|
||||
if (strcmp(tok_buf, dis_str) == 0) {
|
||||
pResult->komm = 0;
|
||||
break;
|
||||
}
|
||||
break;
|
||||
}
|
||||
case 13:
|
||||
break; /* date */
|
||||
case 14:
|
||||
break; /* time */
|
||||
case 15:{
|
||||
sscanf(tok_buf, "%d", &pResult->iHz);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
return (1);
|
||||
}
|
||||
|
||||
/*--------------------------- analyse Dornier status string ----------------
|
||||
This is the version for the NGS037 software from Dornier. Main difference
|
||||
is that the keycodes are in germlish.
|
||||
-------------------------------------------------------------------------*/
|
||||
int DecodeNewDornierStatus(char *pText, pDornierStatus pResult)
|
||||
{
|
||||
int cnt, key_id, sl, sts;
|
||||
long err;
|
||||
char ena_str[] = "ENABLED";
|
||||
char dis_str[] = "DISABLED";
|
||||
char keys[16][14] =
|
||||
{
|
||||
"MODE:\0 ",
|
||||
"R_SPEED:\0 ",
|
||||
"A_SPEED:\0 ",
|
||||
"P_LOSS:\0 ",
|
||||
"R_Current:\0 ",
|
||||
"T_ROT:\0 ",
|
||||
"T_HHH:\0 ",
|
||||
"T_INL:\0 ",
|
||||
"T_OUT:\0",
|
||||
"F_RATE:\0",
|
||||
"A_Vac:\0 ",
|
||||
"V_OSC:\0 ",
|
||||
"COM: \0 ",
|
||||
"DATE: \0 ",
|
||||
"TIME: \0 ",
|
||||
"Hz:\0 "};
|
||||
int DecodeNewDornierStatus(char *pText, pDornierStatus pResult)
|
||||
{
|
||||
int cnt, key_id, sl, sts;
|
||||
long err;
|
||||
char ena_str[] = "ENABLED";
|
||||
char dis_str[] = "DISABLED";
|
||||
char keys[16][14] = {
|
||||
"MODE:\0 ",
|
||||
"R_SPEED:\0 ",
|
||||
"A_SPEED:\0 ",
|
||||
"P_LOSS:\0 ",
|
||||
"R_Current:\0 ",
|
||||
"T_ROT:\0 ",
|
||||
"T_HHH:\0 ",
|
||||
"T_INL:\0 ",
|
||||
"T_OUT:\0",
|
||||
"F_RATE:\0",
|
||||
"A_Vac:\0 ",
|
||||
"V_OSC:\0 ",
|
||||
"COM: \0 ",
|
||||
"DATE: \0 ",
|
||||
"TIME: \0 ",
|
||||
"Hz:\0 "
|
||||
};
|
||||
|
||||
char tok_buf[TOK_BUF_L], *ptr_token, *ptr_src, *ptr;
|
||||
const char tok_c[] = "/\\\0";
|
||||
char status[255];
|
||||
char tok_buf[TOK_BUF_L], *ptr_token, *ptr_src, *ptr;
|
||||
const char tok_c[] = "/\\\0";
|
||||
char status[255];
|
||||
|
||||
ptr_src = pText;
|
||||
memset(pResult,0,sizeof(DornierStatus));
|
||||
ptr_src = pText;
|
||||
memset(pResult, 0, sizeof(DornierStatus));
|
||||
|
||||
/* skip over first token, should be command echo */
|
||||
ptr_token = strtok(ptr_src, tok_c);
|
||||
if (ptr_token == NULL) return 0; /* error */
|
||||
strcpy(pResult->echo,(const char *)ptr_token);
|
||||
ptr_src += strlen(ptr_token);
|
||||
|
||||
ptr_src = NULL; /* necessary for further search with strtok */
|
||||
for (;;)
|
||||
{
|
||||
/* read text till next separator '/' */
|
||||
ptr_token = strtok(ptr_src, tok_c);
|
||||
if (ptr_token == NULL) break;
|
||||
strcpy(tok_buf,ptr_token);
|
||||
/* skip over first token, should be command echo */
|
||||
ptr_token = strtok(ptr_src, tok_c);
|
||||
if (ptr_token == NULL)
|
||||
return 0; /* error */
|
||||
strcpy(pResult->echo, (const char *) ptr_token);
|
||||
ptr_src += strlen(ptr_token);
|
||||
|
||||
for (key_id = 0; key_id<=15; key_id++)
|
||||
{
|
||||
/* search key ? */
|
||||
sl = strlen(keys[key_id]);
|
||||
if (strncmp(&keys[key_id][0], tok_buf, sl) == 0)
|
||||
{
|
||||
/* step over key */
|
||||
for (cnt=0;cnt+sl < TOK_BUF_L; cnt++)
|
||||
tok_buf[cnt] = tok_buf[cnt+sl];
|
||||
switch (key_id)
|
||||
{
|
||||
case 0: {strcpy(pResult->rm, tok_buf); break;}
|
||||
case 1: {sscanf(tok_buf,"%d",&pResult->nom_rpm); break;}
|
||||
case 2: {sscanf(tok_buf,"%d",&pResult->cur_rpm); break;}
|
||||
case 3: {sscanf(tok_buf,"%d",&pResult->pwr); break;}
|
||||
case 4: {sscanf(tok_buf,"%f",&pResult->curr); break;}
|
||||
case 5: {sscanf(tok_buf,"%d",&pResult->rot_temp); break;}
|
||||
case 6: {sscanf(tok_buf,"%d",&pResult->cont_temp); break;}
|
||||
case 7: {sscanf(tok_buf,"%d",&pResult->inl_temp); break;}
|
||||
case 8: {sscanf(tok_buf,"%d",&pResult->outl_temp); break;}
|
||||
case 9: {sscanf(tok_buf,"%f",&pResult->cool_wat); break;}
|
||||
case 10: {sscanf(tok_buf,"%f",&pResult->vacuum); break;}
|
||||
case 11: {sscanf(tok_buf,"%f",&pResult->accel); break;}
|
||||
case 12: {
|
||||
if (strcmp(tok_buf, ena_str) == 0)
|
||||
{pResult->komm = 1; break;}
|
||||
if (strcmp(tok_buf, dis_str) == 0)
|
||||
{pResult->komm = 0;break;}
|
||||
break;
|
||||
}
|
||||
case 13: break; /* date */
|
||||
case 14: break; /* time */
|
||||
case 15: {sscanf(tok_buf,"%d",&pResult->iHz); break;}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
return(1);
|
||||
}
|
||||
/*-------------------------------------------------------------------------*/
|
||||
int DornierSend(void **pData, char *pCommand, char *pReply, int iRepLen)
|
||||
{
|
||||
char pOldCom[10];
|
||||
char *pPtr;
|
||||
int iRet;
|
||||
|
||||
/* first copy the command send out, in order to test for echo */
|
||||
pPtr = pCommand;
|
||||
memset(pOldCom,0,10);
|
||||
while( isspace(*pPtr) && (*pPtr != '\0') )
|
||||
{
|
||||
pPtr++;
|
||||
}
|
||||
if(*pPtr == '\0') /* no command */
|
||||
{
|
||||
return NOCOMMAND;
|
||||
ptr_src = NULL; /* necessary for further search with strtok */
|
||||
for (;;) {
|
||||
/* read text till next separator '/' */
|
||||
ptr_token = strtok(ptr_src, tok_c);
|
||||
if (ptr_token == NULL)
|
||||
break;
|
||||
strcpy(tok_buf, ptr_token);
|
||||
|
||||
for (key_id = 0; key_id <= 15; key_id++) {
|
||||
/* search key ? */
|
||||
sl = strlen(keys[key_id]);
|
||||
if (strncmp(&keys[key_id][0], tok_buf, sl) == 0) {
|
||||
/* step over key */
|
||||
for (cnt = 0; cnt + sl < TOK_BUF_L; cnt++)
|
||||
tok_buf[cnt] = tok_buf[cnt + sl];
|
||||
switch (key_id) {
|
||||
case 0:{
|
||||
strcpy(pResult->rm, tok_buf);
|
||||
break;
|
||||
}
|
||||
case 1:{
|
||||
sscanf(tok_buf, "%d", &pResult->nom_rpm);
|
||||
break;
|
||||
}
|
||||
case 2:{
|
||||
sscanf(tok_buf, "%d", &pResult->cur_rpm);
|
||||
break;
|
||||
}
|
||||
case 3:{
|
||||
sscanf(tok_buf, "%d", &pResult->pwr);
|
||||
break;
|
||||
}
|
||||
case 4:{
|
||||
sscanf(tok_buf, "%f", &pResult->curr);
|
||||
break;
|
||||
}
|
||||
case 5:{
|
||||
sscanf(tok_buf, "%d", &pResult->rot_temp);
|
||||
break;
|
||||
}
|
||||
case 6:{
|
||||
sscanf(tok_buf, "%d", &pResult->cont_temp);
|
||||
break;
|
||||
}
|
||||
case 7:{
|
||||
sscanf(tok_buf, "%d", &pResult->inl_temp);
|
||||
break;
|
||||
}
|
||||
case 8:{
|
||||
sscanf(tok_buf, "%d", &pResult->outl_temp);
|
||||
break;
|
||||
}
|
||||
case 9:{
|
||||
sscanf(tok_buf, "%f", &pResult->cool_wat);
|
||||
break;
|
||||
}
|
||||
case 10:{
|
||||
sscanf(tok_buf, "%f", &pResult->vacuum);
|
||||
break;
|
||||
}
|
||||
case 11:{
|
||||
sscanf(tok_buf, "%f", &pResult->accel);
|
||||
break;
|
||||
}
|
||||
case 12:{
|
||||
if (strcmp(tok_buf, ena_str) == 0) {
|
||||
pResult->komm = 1;
|
||||
break;
|
||||
}
|
||||
if (strcmp(tok_buf, dis_str) == 0) {
|
||||
pResult->komm = 0;
|
||||
break;
|
||||
}
|
||||
break;
|
||||
}
|
||||
case 13:
|
||||
break; /* date */
|
||||
case 14:
|
||||
break; /* time */
|
||||
case 15:{
|
||||
sscanf(tok_buf, "%d", &pResult->iHz);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
strncpy(pOldCom,pPtr,3);
|
||||
|
||||
iRet = SerialWriteRead(pData, pCommand, pReply, iRepLen);
|
||||
}
|
||||
}
|
||||
return (1);
|
||||
}
|
||||
|
||||
/*-------------------------------------------------------------------------*/
|
||||
int DornierSend(void **pData, char *pCommand, char *pReply, int iRepLen)
|
||||
{
|
||||
char pOldCom[10];
|
||||
char *pPtr;
|
||||
int iRet;
|
||||
|
||||
/* first copy the command send out, in order to test for echo */
|
||||
pPtr = pCommand;
|
||||
memset(pOldCom, 0, 10);
|
||||
while (isspace(*pPtr) && (*pPtr != '\0')) {
|
||||
pPtr++;
|
||||
}
|
||||
if (*pPtr == '\0') { /* no command */
|
||||
return NOCOMMAND;
|
||||
}
|
||||
strncpy(pOldCom, pPtr, 3);
|
||||
|
||||
iRet = SerialWriteRead(pData, pCommand, pReply, iRepLen);
|
||||
/*
|
||||
iRet = SerialSicsExecute(pData,pCommand,pReply,iRepLen);
|
||||
*/
|
||||
if(iRet != 1)
|
||||
{
|
||||
return iRet; /* an error ocurred */
|
||||
}
|
||||
|
||||
/* try to find command in the reply */
|
||||
pPtr = strstr(pReply,pOldCom);
|
||||
if(pPtr == NULL)
|
||||
{
|
||||
SICSLogWrite("Velocity Selector: Bad Reply:",eError);
|
||||
SICSLogWrite(pReply,eError);
|
||||
return ECHOMISSING;
|
||||
}
|
||||
return 1;
|
||||
if (iRet != 1) {
|
||||
return iRet; /* an error ocurred */
|
||||
}
|
||||
|
||||
/* try to find command in the reply */
|
||||
pPtr = strstr(pReply, pOldCom);
|
||||
if (pPtr == NULL) {
|
||||
SICSLogWrite("Velocity Selector: Bad Reply:", eError);
|
||||
SICSLogWrite(pReply, eError);
|
||||
return ECHOMISSING;
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
|
||||
/*-------------------------------------------------------------------------*/
|
||||
int GetDornierStatus(void **pData, pDornierStatus pDornier)
|
||||
{
|
||||
char pCommand[10] = {"???"};
|
||||
char pReply[256];
|
||||
int iRet;
|
||||
|
||||
/* send command */
|
||||
iRet = DornierSend(pData,pCommand,pReply,255);
|
||||
if(iRet < 0 )
|
||||
{
|
||||
return iRet;
|
||||
}
|
||||
if(strlen(pReply) < 100)
|
||||
{
|
||||
SICSLogWrite("Velocity Selector: Bad Reply:",eError);
|
||||
SICSLogWrite(pReply,eError);
|
||||
return INVALIDSTATUS;
|
||||
}
|
||||
|
||||
|
||||
/* analyse reply */
|
||||
iRet = AnalyseDornierStatus(pReply,pDornier);
|
||||
if(!iRet)
|
||||
{
|
||||
return BADANALYSIS;
|
||||
}
|
||||
if(pDornier->cur_rpm > 70000)
|
||||
{
|
||||
printf("Shitty status reply: %s detected \n",pReply);
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
int GetDornierStatus(void **pData, pDornierStatus pDornier)
|
||||
{
|
||||
char pCommand[10] = { "???" };
|
||||
char pReply[256];
|
||||
int iRet;
|
||||
|
||||
/* send command */
|
||||
iRet = DornierSend(pData, pCommand, pReply, 255);
|
||||
if (iRet < 0) {
|
||||
return iRet;
|
||||
}
|
||||
if (strlen(pReply) < 100) {
|
||||
SICSLogWrite("Velocity Selector: Bad Reply:", eError);
|
||||
SICSLogWrite(pReply, eError);
|
||||
return INVALIDSTATUS;
|
||||
}
|
||||
|
||||
|
||||
/* analyse reply */
|
||||
iRet = AnalyseDornierStatus(pReply, pDornier);
|
||||
if (!iRet) {
|
||||
return BADANALYSIS;
|
||||
}
|
||||
if (pDornier->cur_rpm > 70000) {
|
||||
printf("Shitty status reply: %s detected \n", pReply);
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user