eddy/BTA_utils
1
0
Fork 0
mirror of https://github.com/eddyem/BTA_utils.git synced 2026-03-21 09:11:00 +03:00
Code Issues Packages Projects Releases Wiki Activity

some fixes with meteo

Browse Source
This commit is contained in:
Edward Emelianov
2022-07-04 18:05:08 +03:00
parent a00200af3c
commit 478ad21c7a
4 changed files with 197 additions and 212 deletions
Download Patch File Download Diff File Expand all files Collapse all files

371
BTA_modbusmeteo/olddaemon/bta_meteo_can.c
View File

@@ -67,19 +67,18 @@ static void myabort(int sig) {
char ss[10], tmp[80];
signal(sig,SIG_IGN);
switch (sig) {
case SIGHUP : strcpy(ss,"SIGHUP"); break;
case SIGINT : strcpy(ss,"SIGINT"); break;
case SIGQUIT: strcpy(ss,"SIGQUIT"); break;
case SIGFPE : strcpy(ss,"SIGFPE"); break;
case SIGPIPE: strcpy(ss,"SIGPIPE"); break;
case SIGSEGV: strcpy(ss,"SIGSEGV"); break;
case SIGTERM: strcpy(ss,"SIGTERM"); break;
default: sprintf(ss,"SIG_%d",sig); break;
case SIGHUP : strcpy(ss,"SIGHUP"); break;
case SIGINT : strcpy(ss,"SIGINT"); break;
case SIGQUIT: strcpy(ss,"SIGQUIT"); break;
case SIGFPE : strcpy(ss,"SIGFPE"); break;
case SIGPIPE: strcpy(ss,"SIGPIPE"); break;
case SIGSEGV: strcpy(ss,"SIGSEGV"); break;
case SIGTERM: strcpy(ss,"SIGTERM"); break;
default: sprintf(ss,"SIG_%d",sig); break;
}
print_date(stderr);
switch (sig) {
default:
case SIGHUP :
case SIGINT :
fprintf(stderr,"%s: %s - Ignore .....\n",myname,ss);
@@ -102,8 +101,7 @@ static void myabort(int sig) {
static int rxpnt;
static double rxtime;
int main (int argc, char *argv[])
{
int main (int argc, char *argv[]){
double tcurr, tlast, tok, twndok;
char msg[60];
double t0=0., t;
@@ -139,200 +137,169 @@ int main (int argc, char *argv[])
t0 = tcurr = tlast = tok = twndok = dtime();
tok -= 600.;
while (1) {
char *pep = "RK";
int nch = 0;
dsleep(0.2);
tcurr = dtime();
if(PEP_A_On && PEP_R_On) {
if(!stop_prog && !start && tcurr-tok>15.) {
idt = 0x447;
dlen=6;
tdata[0] = 7;
tdata[2] = 50; /* 0.5s */
tdata[3] = 1;
tdata[4] = 0; tdata[5] = 50; /* 0.5s */
for(i=0; i<8; i++) {
if(i==2||i==3||i==5||i==6) /* T-ÚÅÒËÁÌÁ, ×ÅÔÅÒ, ×ÌÁÖÎÏÓÔØ, T ÎÁ ÍÅÔÅÏ-ÍÁÞÔÅ */
continue; /* ÐÏËÁ ÎÅ ÉÓÐÏÌØÚÕÀÔÓÑ (ÚÁÍÅÎÅÎÙ) */
if(i==4) { /*×ÒÅÍÅÎÎÏ: ÐÏËÁ áãð4 ÉÄÅÔ Ó PEP-A (ÄÁ×ÌÅÎÉÅ)*/
pep = "A";
idt = 0x40f; /* PEP-A */
tdata[1] = nch = 4; /* áãð/4 */
} else {
pep = "RK";
idt = 0x447; /* PEP-RK */
tdata[1] = nch = i; /* áãð/i */
while (1){
char *pep = "RK";
int nch = 0;
dsleep(0.2);
tcurr = dtime();
if(PEP_A_On && PEP_R_On){
if(!stop_prog && !start && tcurr-tok>15.) {
idt = 0x447;
dlen=6;
tdata[0] = 7;
tdata[2] = 50; /* 0.5s */
tdata[3] = 1;
tdata[4] = 0; tdata[5] = 50; /* 0.5s */
for(i=0; i<8; i++) {
if(i==2||i==4|i==3||i==5||i==6) /* T-ÚÅÒËÁÌÁ, ×ÅÔÅÒ, ÄÁ×ÌÅÎÉÅ, ×ÌÁÖÎÏÓÔØ, T ÎÁ ÍÅÔÅÏ-ÍÁÞÔÅ */
continue; /* ÐÏËÁ ÎÅ ÉÓÐÏÌØÚÕÀÔÓÑ (ÚÁÍÅÎÅÎÙ) */
pep = "RK";
idt = 0x447; /* PEP-RK */
tdata[1] = nch = i; /* áãð/i */
print_date(stderr);
if(can_send_frame(idt, dlen, tdata)<=0) {
fprintf(stderr, "Can't send command \"Start ADC%d\" to PEP-%s!\n", nch,pep);
} else if(tcurr-tlast<70.)
fprintf(stderr, "Send command \"Start ADC%d\" to PEP-%s.\n", nch,pep);
fflush(stderr);
}
start=1;
tok = tcurr;
}
print_date(stderr);
if(can_send_frame(idt, dlen, tdata)<=0) {
fprintf(stderr,"Can't send command \"Start ADC%d\" to PEP-%s!\n",nch,pep);
} else if(tcurr-tlast<70.)
fprintf(stderr,"Send command \"Start ADC%d\" to PEP-%s.\n",nch,pep);
fflush(stderr);
}
start=1;
tok = tcurr;
}
if(stop_prog || (start && tcurr-tok>5.)) {
if(!stop_prog) {
print_date(stderr);
fprintf(stderr,"PEP-RK: ADC(0,1,7) (or PEP-A ADC4) timeout!\n");
}
#if 0
MeteoMode &= ~SENSOR_T2;
idt = 0x447;
dlen=6;
tdata[0] = 7;
tdata[2] = tdata[3] = tdata[4] = tdata[5] = 0;
for(i=0; i<8; i++) {
if(i==2||i==3||i==5||i==6) /* T-ÚÅÒËÁÌÁ, ×ÅÔÅÒ, ×ÌÁÖÎÏÓÔØ, T ÎÁ ÍÅÔÅÏ-ÍÁÞÔÅ */
continue; /* ÐÏËÁ ÎÅ ÉÓÐÏÌØÚÕÀÔÓÑ (ÚÁÍÅÎÅÎÙ) */
if(i==4) { /*×ÒÅÍÅÎÎÏ: ÐÏËÁ áãð4 ÉÄÅÔ Ó PEP-A (ÄÁ×ÌÅÎÉÅ)*/
pep = "A";
idt = 0x40f; /* PEP-A */
tdata[1] = nch = 4; /* áãð/4 */
} else {
pep = "RK";
idt = 0x447; /* PEP-RK */
tdata[1] = nch = i; /* áãð/i */
if(stop_prog || (start && tcurr-tok>5.)) {
if(!stop_prog) {
print_date(stderr);
fprintf(stderr,"PEP-RK: ADC(0,1,7) (or PEP-A ADC4) timeout!\n");
}
MeteoMode &= ~SENSOR_T2;
idt = 0x447;
dlen=6;
tdata[0] = 7;
tdata[2] = tdata[3] = tdata[4] = tdata[5] = 0;
for(i=0; i<8; i++) {
if(i==2||i==3||i==5||i==6) /* T-ÚÅÒËÁÌÁ, ×ÅÔÅÒ, ×ÌÁÖÎÏÓÔØ, T ÎÁ ÍÅÔÅÏ-ÍÁÞÔÅ */
continue; /* ÐÏËÁ ÎÅ ÉÓÐÏÌØÚÕÀÔÓÑ (ÚÁÍÅÎÅÎÙ) */
if(i==4) { /*×ÒÅÍÅÎÎÏ: ÐÏËÁ áãð4 ÉÄÅÔ Ó PEP-A (ÄÁ×ÌÅÎÉÅ)*/
pep = "A";
idt = 0x40f; /* PEP-A */
tdata[1] = nch = 4; /* áãð/4 */
} else {
pep = "RK";
idt = 0x447; /* PEP-RK */
tdata[1] = nch = i; /* áãð/i */
}
print_date(stderr);
if(can_send_frame(idt, dlen, tdata)<=0) {
fprintf(stderr,"Can't send command \"Stop ADC%d\" to PEP-%s!\n",nch,pep);
} else if(tcurr-tlast<70.)
fprintf(stderr,"Send command \"Stop ADC%d\" to PEP-%s.\n",nch,pep);
fflush(stderr);
}
if(stop_prog) can_exit(0);
start=0;
tok = tcurr;
}
print_date(stderr);
if(can_send_frame(idt, dlen, tdata)<=0) {
fprintf(stderr,"Can't send command \"Stop ADC%d\" to PEP-%s!\n",nch,pep);
} else if(tcurr-tlast<70.)
fprintf(stderr,"Send command \"Stop ADC%d\" to PEP-%s.\n",nch,pep);
fflush(stderr);
}
#endif
if(stop_prog) can_exit(0);
start=0;
tok = tcurr;
}
} else {
if(stop_prog) can_exit(0);
else {
static int tpr = 0;
if(tcurr-tpr>600.) {
if(PEP_R_Off) {
print_date(stderr);
fprintf(stderr,"PEP-RK (ADC0/1/7) turned off!\n");
} else {
if(stop_prog) can_exit(0);
else {
static int tpr = 0;
if(tcurr-tpr>600.) {
if(PEP_R_Off) {
print_date(stderr);
fprintf(stderr,"PEP-RK (ADC0/1/7) turned off!\n");
}
if(PEP_A_Off) {
print_date(stderr);
fprintf(stderr,"PEP-A (ADC4) turned off!\n");
}
tpr=tcurr;
}
if(PEP_R_Off) {
if((MeteoMode & NET_T2)==0)
MeteoMode &= ~SENSOR_T2;
}
}
if(PEP_A_Off) {
print_date(stderr);
fprintf(stderr,"PEP-A (ADC4) turned off!\n");
}
while(can_recv_frame(&rxpnt, &rxtime, &idr, &dlen, rdata)) {
int rcode = 0;
t = rxtime;
if((idr&0xff8)==0x220) { /* ËÏÄ ÏÔ áãð PEP-RK */
static double T2 = 0.;
static int terr=0;
int chan, code;
double volt,T,b,w,h;
adc_pep_rk:
if(dlen!=3) {
static double last_print = 0.;
wrong_frame:
if(tcurr-last_print > 60.) {
print_date(stderr);
fprintf(stderr,"Wrong CAN-frame id=0x%x len=%d < ",idr,dlen);
for(i=0; i<dlen; i++) fprintf(stderr,"%02x ",rdata[i]);
fprintf(stderr,">\n");
fflush(stderr);
last_print = tcurr;
}
continue;
}
chan = idr&7;
code = (unsigned int)rdata[0]<<8|rdata[1];
volt = (double)code/4096.*5.; /* ADC 12bit 0-5V */
if(chan == 1){ /* áãð1 - T-ÐÏÄËÕÐÏÌØÎÏÇÏ */
T = zeroT2 + (volt-zeroV)*scaleT;
/*t2=T;*/
if(T >= -20. && T <= 30.) {
if((MeteoMode & SENSOR_T2) && fabs(T2-T)<5.) {
if(fabs(T2-T)>0.1)
T2 += (T2>T)? -0.005 : 0.005;
else
T2 = 0.9*T2 + 0.1*T;
} else {
T2=T;
MeteoMode |= SENSOR_T2;
}
} else {
terr |= 2;
if(T<-20.) T2=-20.;
else if(T>30.) T2=30.;
MeteoMode &= ~SENSOR_T2;
}
if((MeteoMode & INPUT_T2)== 0 && (MeteoMode & SENSOR_T2))
val_T2 = T2;
//printf("Get T=%.1f\n", T2);
tok = t;
}
tok = tlast = t;
}else if(idr==0x21){ /* ÐÒÉÎÑÔ ËÏÄ RK ÏÔ PEP-ËÏÎÔÒÏÌÌÅÒÁ */
static double off_time = 0.;
static double last_msg_time = 0.;
static char msg[30] = " ôÕÍÁÎ ÉÌÉ ÏÓÁÄËÉ.";
static int o_rcode = 0;
rcode = ((unsigned int)rdata[0]<<16)|((unsigned int)rdata[1]<<8)|rdata[2];
if(rcode & RK_Precipitations){
if(o_rcode & RK_Precipitations){ // ÄÁÔÞÉË ÏÓÁÄËÏ× ÉÍÅÎÉ äÁÎÉÌÏ×Á ÎÁ ÍÅÔÅÏ-ÍÁÞÔÅ
if(fabs(M_time-Precip_time>60.)){ // ÄÁÔÞÉË ÏÓÁÄËÏ× ×ËÌÀÞÅÎ 2 ÓÞÉÔÙ×ÁÎÉÑ ÐÏÄÒÑÄ
if(Tel_State!=Stopping && Dome_State!=D_Off && fabs(M_time-last_msg_time>30.)){ // ÒÅÁÇÉÒÏ×ÁÔØ ÎÁ ÎÅÇÏ ÎÅ ÞÁÝÅ ÒÁÚÁ × ÍÉÎÕÔÕ
*msg = MesgFault; // ×ÙÄÁÔØ ÓÏÏÂÝÅÎÉÅ ÅÓÌÉ ÉÄÕÔ ÒÅÁÌØÎÙÅ ÎÁÂÌÀÄÅÎÉÑ
SendMessage(msg);
last_msg_time = M_time;
}
if(fabs(M_time-off_time)>3.){ // ÐÏÓÔÏÑÎÎÏ ×ËÌÀÞÅÎ ÍÉÎÉÍÕÍ 3ÓÅË
Precip_time = M_time; /* ÉÎÆÏÒÍÉÒÏ×ÁÔØ ÄÒÕÇÉÅ ÐÒÏÇÒÁÍÍÙ */
}
}
}else{ // ÄÁÔÞÉË ÏÓÁÄËÏ× ÔÏÌØËÏ ÞÔÏ ×ËÌÀÞÉÌÓÑ
if(fabs(M_time-last_msg_time>600.)){ // ×ÙÄÁ×ÁÔØ ÓÏÏÂÝÅÎÉÅ ÒÁÚ × 10 ÍÉÎ
*msg = MesgWarn;
SendMessage(msg);
last_msg_time = M_time;
}
}
}else off_time = M_time;
o_rcode = rcode;
}
tpr=tcurr;
}
if(PEP_R_Off) {
if((MeteoMode & NET_T2)==0)
MeteoMode &= ~SENSOR_T2;
}
}
}
while(can_recv_frame(&rxpnt, &rxtime, &idr, &dlen, rdata)) {
int rcode = 0;
t = rxtime;
if(idr==0x447||idr==0x40f) {
pep = (idr==0x40f)? "A" : "RK";
if(rdata[0]==7) {
if(rdata[2] == 0 && rdata[3] == 0)
fprintf(stderr,"%s PEP-%s: Echo command \"Stop ADC%d\"\n", time2asc(rxtime-timezone),pep,rdata[1]);
else
fprintf(stderr,"%s PEP-%s: Echo command \"Start ADC%d\"\n", time2asc(rxtime-timezone),pep,rdata[1]);
} else if(rdata[0]==8) {
fprintf(stderr,"%s PEP-%s: Echo command \"Stop all ADC\"\n", time2asc(rxtime-timezone),pep);
start=0;
}
fflush(stderr);
} else if(idr==0x20c) { /* ×ÒÅÍÅÎÎÏ: ËÏÄ áãð4 PEP-A - ÄÁ×ÌÅÎÉÅ */
if(dlen!=3)
goto wrong_frame;
idr = 0x224; /* ×ÒÅÍÅÎÎÏ: ÉÍÉÔÁÃÉÑ áãð4 PEP-RK */
goto adc_pep_rk;
} else if((idr&0xff8)==0x220) { /* ËÏÄ ÏÔ áãð PEP-RK */
static double T2 = 0.;
static int ctm=0;
static int terr=0;
int chan, code;
double volt,T,b,w,h;
adc_pep_rk:
if(dlen!=3) {
static double last_print = 0.;
wrong_frame:
if(tcurr-last_print > 60.) {
print_date(stderr);
fprintf(stderr,"Wrong CAN-frame id=0x%x len=%d < ",idr,dlen);
for(i=0; i<dlen; i++) fprintf(stderr,"%02x ",rdata[i]);
fprintf(stderr,">\n");
fflush(stderr);
last_print = tcurr;
}
continue;
}
chan = idr&7;
code = (unsigned int)rdata[0]<<8|rdata[1];
volt = (double)code/4096.*5.; /* ADC 12bit 0-5V */
if(chan == 1){ /* áãð1 - T-ÐÏÄËÕÐÏÌØÎÏÇÏ */
ctm |= 2; /* áãð1 - T-ÐÏÄËÕÐÏÌØÎÏÇÏ */
T = zeroT2 + (volt-zeroV)*scaleT;
/*t2=T;*/
if(T >= -20. && T <= 30.) {
if((MeteoMode & SENSOR_T2) && fabs(T2-T)<5.) {
if(fabs(T2-T)>0.1)
T2 += (T2>T)? -0.005 : 0.005;
else
T2 = 0.9*T2 + 0.1*T;
} else {
T2=T;
MeteoMode |= SENSOR_T2;
}
} else {
terr |= 2;
if(T<-20.) T2=-20.;
else if(T>30.) T2=30.;
MeteoMode &= ~SENSOR_T2;
}
if((MeteoMode & INPUT_T2)== 0 && (MeteoMode & SENSOR_T2))
val_T2 = T2;
//printf("Get T=%.1f\n", T2);
tok = t;
}
if(chan<3 && (ctm&0x93) == 0x93) { /* áãð-0,1,4,7 - Ok */
tok = t;
ctm=0;
}
tlast=t;
}else if(idr==0x21){ /* ÐÒÉÎÑÔ ËÏÄ RK ÏÔ PEP-ËÏÎÔÒÏÌÌÅÒÁ */
static double off_time = 0.;
static double last_msg_time = 0.;
static char msg[30] = " ôÕÍÁÎ ÉÌÉ ÏÓÁÄËÉ.";
static int o_rcode = 0;
rcode = ((unsigned int)rdata[0]<<16)|((unsigned int)rdata[1]<<8)|rdata[2];
if(rcode & RK_Precipitations){
if(o_rcode & RK_Precipitations){ // ÄÁÔÞÉË ÏÓÁÄËÏ× ÉÍÅÎÉ äÁÎÉÌÏ×Á ÎÁ ÍÅÔÅÏ-ÍÁÞÔÅ
if(fabs(M_time-Precip_time>60.)){ // ÄÁÔÞÉË ÏÓÁÄËÏ× ×ËÌÀÞÅÎ 2 ÓÞÉÔÙ×ÁÎÉÑ ÐÏÄÒÑÄ
if(Tel_State!=Stopping && Dome_State!=D_Off && fabs(M_time-last_msg_time>30.)){ // ÒÅÁÇÉÒÏ×ÁÔØ ÎÁ ÎÅÇÏ ÎÅ ÞÁÝÅ ÒÁÚÁ × ÍÉÎÕÔÕ
*msg = MesgFault; // ×ÙÄÁÔØ ÓÏÏÂÝÅÎÉÅ ÅÓÌÉ ÉÄÕÔ ÒÅÁÌØÎÙÅ ÎÁÂÌÀÄÅÎÉÑ
SendMessage(msg);
last_msg_time = M_time;
}
if(fabs(M_time-off_time)>3.){ // ÐÏÓÔÏÑÎÎÏ ×ËÌÀÞÅÎ ÍÉÎÉÍÕÍ 3ÓÅË
Precip_time = M_time; /* ÉÎÆÏÒÍÉÒÏ×ÁÔØ ÄÒÕÇÉÅ ÐÒÏÇÒÁÍÍÙ */
}
}
}else{ // ÄÁÔÞÉË ÏÓÁÄËÏ× ÔÏÌØËÏ ÞÔÏ ×ËÌÀÞÉÌÓÑ
if(fabs(M_time-last_msg_time>600.)){ // ×ÙÄÁ×ÁÔØ ÓÏÏÂÝÅÎÉÅ ÒÁÚ × 10 ÍÉÎ
*msg = MesgWarn;
SendMessage(msg);
last_msg_time = M_time;
}
}
}else off_time = M_time;
o_rcode = rcode;
}
fflush(stdout);
}
if(stop_prog) can_exit(0);
fflush(stdout);
}
if(stop_prog) can_exit(0);
}
}