mirror of
https://github.com/eddyem/BTA_utils.git
synced 2026-08-14 03:59:24 +03:00
copy
This commit is contained in:
Eddy
380
jsonbta/bta_print.c
Normal file
380
jsonbta/bta_print.c
Normal file
@@ -0,0 +1,380 @@
|
||||
/*
|
||||
* bta_print.c
|
||||
*
|
||||
* Copyright Vladimir S. Shergin <vsher@sao.ru>
|
||||
*
|
||||
* some changes (2013) Edward V. Emelianoff <eddy@sao.ru>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
|
||||
* MA 02110-1301, USA.
|
||||
*/
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <errno.h>
|
||||
#include <math.h>
|
||||
#include <time.h>
|
||||
#include <sys/time.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/times.h>
|
||||
#include <crypt.h>
|
||||
#include <assert.h>
|
||||
|
||||
#include "bta_shdata.h"
|
||||
#define BTA_PRINT_C
|
||||
#include "bta_json.h"
|
||||
|
||||
#define BUFSZ 255
|
||||
static char buf[BUFSZ+1];
|
||||
|
||||
char *double_asc(double d, char *fmt){
|
||||
if(!fmt) snprintf(buf, BUFSZ, "%.6f", d);
|
||||
else snprintf(buf, BUFSZ, fmt, d);
|
||||
return buf;
|
||||
}
|
||||
|
||||
char *time_asc(double t){
|
||||
int h, min;
|
||||
double sec;
|
||||
h = (int)(t/3600.);
|
||||
min = (int)((t - (double)h*3600.)/60.);
|
||||
sec = t - (double)h*3600. - (double)min*60.;
|
||||
h %= 24;
|
||||
if(sec>59.99) sec=59.99;
|
||||
snprintf(buf, BUFSZ, "\"%02d:%02d:%05.2f\"", h,min,sec);
|
||||
return buf;
|
||||
}
|
||||
|
||||
char *angle_asc(double a){
|
||||
char s;
|
||||
int d, min;
|
||||
double sec;
|
||||
if (a >= 0.)
|
||||
s = '+';
|
||||
else {
|
||||
s = '-'; a = -a;
|
||||
}
|
||||
d = (int)(a/3600.);
|
||||
min = (int)((a - (double)d*3600.)/60.);
|
||||
sec = a - (double)d*3600. - (double)min*60.;
|
||||
d %= 360;
|
||||
if(sec>59.9) sec=59.9;
|
||||
snprintf (buf, BUFSZ, "\"%c%02d:%02d:%04.1f\"", s,d,min,sec);
|
||||
return buf;
|
||||
}
|
||||
|
||||
char *angle_fmt(double a, char *format){
|
||||
char s, *p;
|
||||
int d, min, n;
|
||||
double sec, msec;
|
||||
char *newformat = calloc(strlen(format) + 3, 1);
|
||||
assert(newformat);
|
||||
sprintf(newformat, "\"%s\"", format);
|
||||
if (a >= 0.)
|
||||
s = '+';
|
||||
else {
|
||||
s = '-'; a = -a;
|
||||
}
|
||||
d = (int)(a/3600.);
|
||||
min = (int)((a - (double)d*3600.)/60.);
|
||||
sec = a - (double)d*3600. - (double)min*60.;
|
||||
d %= 360;
|
||||
if ((p = strchr(format,'.')) == NULL)
|
||||
msec=59.;
|
||||
else if (*(p+2) == 'f' ) {
|
||||
n = *(p+1) - '0';
|
||||
msec = 60. - pow(10.,(double)(-n));
|
||||
} else
|
||||
msec=60.;
|
||||
if(sec>msec) sec=msec;
|
||||
if (strstr(format,"%c"))
|
||||
snprintf(buf, BUFSZ, newformat, s,d,min,sec);
|
||||
else
|
||||
snprintf(buf, BUFSZ, newformat, d,min,sec);
|
||||
free(newformat);
|
||||
return buf;
|
||||
}
|
||||
|
||||
#ifndef PI
|
||||
#define PI 3.14159265358979323846 /* pi */
|
||||
#endif
|
||||
|
||||
#define R2D 180./PI /* rad. to degr. */
|
||||
#define D2R PI/180. /* degr. to rad. */
|
||||
#define R2S 648000./PI /* rad. to sec */
|
||||
#define S2R PI/648000. /* sec. to rad. */
|
||||
#define S360 1296000. /* sec in 360degr */
|
||||
|
||||
const double longitude=149189.175; /* SAO longitude 41 26 29.175 (-2:45:45.945)*/
|
||||
const double Fi=157152.7; /* SAO latitude 43 39 12.7 */
|
||||
const double cos_fi=0.7235272793; /* Cos of SAO latitude */
|
||||
const double sin_fi=0.6902957888; /* Sin --- "" ----- */
|
||||
|
||||
static void calc_AZ(double alpha, double delta, double stime, double *az, double *zd){
|
||||
double sin_t,cos_t, sin_d,cos_d, cos_z;
|
||||
double t, d, z, a, x, y;
|
||||
|
||||
t = (stime - alpha) * 15.;
|
||||
if (t < 0.)
|
||||
t += S360; // +360degr
|
||||
t *= S2R; // -> rad
|
||||
d = delta * S2R;
|
||||
sin_t = sin(t);
|
||||
cos_t = cos(t);
|
||||
sin_d = sin(d);
|
||||
cos_d = cos(d);
|
||||
|
||||
cos_z = cos_fi * cos_d * cos_t + sin_fi * sin_d;
|
||||
z = acos(cos_z);
|
||||
|
||||
y = cos_d * sin_t;
|
||||
x = cos_d * sin_fi * cos_t - cos_fi * sin_d;
|
||||
a = atan2(y, x);
|
||||
|
||||
*zd = z * R2S;
|
||||
*az = a * R2S;
|
||||
}
|
||||
|
||||
static double calc_PA(double alpha, double delta, double stime){
|
||||
double sin_t,cos_t, sin_d,cos_d;
|
||||
double t, d, p, sp, cp;
|
||||
|
||||
t = (stime - alpha) * 15.;
|
||||
if (t < 0.)
|
||||
t += S360; // +360degr
|
||||
t *= S2R; // -> rad
|
||||
d = delta * S2R;
|
||||
sin_t = sin(t);
|
||||
cos_t = cos(t);
|
||||
sin_d = sin(d);
|
||||
cos_d = cos(d);
|
||||
|
||||
sp = sin_t * cos_fi;
|
||||
cp = sin_fi * cos_d - sin_d * cos_fi * cos_t;
|
||||
p = atan2(sp, cp);
|
||||
if (p < 0.0)
|
||||
p += 2.0*PI;
|
||||
|
||||
return(p * R2S);
|
||||
}
|
||||
|
||||
/*
|
||||
static void calc_AD(double az, double zd, double stime, double *alpha, double *delta){
|
||||
double sin_d, sin_a,cos_a, sin_z,cos_z;
|
||||
double t, d, z, a, p , x, y, s;
|
||||
a = az * S2R;
|
||||
z = zd * S2R;
|
||||
sin_a = sin(a);
|
||||
cos_a = cos(a);
|
||||
sin_z = sin(z);
|
||||
cos_z = cos(z);
|
||||
|
||||
y = sin_z * sin_a;
|
||||
x = cos_a * sin_fi * sin_z + cos_fi * cos_z;
|
||||
t = atan2(y, x);
|
||||
if (t < 0.0)
|
||||
t += 2.0*PI;
|
||||
|
||||
sin_d = sin_fi * cos_z - cos_fi * cos_a * sin_z;
|
||||
d = asin(sin_d);
|
||||
|
||||
*delta = d * R2S;
|
||||
*alpha = (stime - t * R2S / 15.);
|
||||
if (*alpha < 0.0)
|
||||
*alpha += S360/15.; // +24h
|
||||
}*/
|
||||
|
||||
void make_JSON(int sock, bta_pars *par){
|
||||
bool ALL = par->ALL;
|
||||
// print next JSON pair; par, val - strings
|
||||
void sendstr(char *str){
|
||||
size_t L = strlen(str);
|
||||
if(send(sock, str, L, 0) != L) exit(-1);
|
||||
}
|
||||
int json_send(char *par, char *val){
|
||||
char buf[256];
|
||||
int L = snprintf(buf, 255, ",\n\"%s\": %s", par, val);
|
||||
if(send(sock, buf, L, 0) != L) return -1;
|
||||
return 0;
|
||||
}
|
||||
int json_send_s(char *par, char *val){
|
||||
char buf[256];
|
||||
int L = snprintf(buf, 255, ",\n\"%s\": \"%s\"", par, val);
|
||||
if(send(sock, buf, L, 0) != L) return -1;
|
||||
return 0;
|
||||
}
|
||||
#define JSON(p, val) do{if(json_send(p, val)) exit(-1);} while(0)
|
||||
#define JSONSTR(p, val) do{if(json_send_s(p, val)) exit(-1);} while(0)
|
||||
get_shm_block( &sdat, ClientSide);
|
||||
char *str;
|
||||
if(!check_shm_block(&sdat)) exit(-1);
|
||||
// beginning of json object
|
||||
sendstr("{\n\"ACS_BTA\": true");
|
||||
|
||||
// mean local time
|
||||
if(ALL || par->mtime)
|
||||
JSON("M_time", time_asc(M_time+DUT1));
|
||||
// Mean Sidereal Time
|
||||
if(ALL || par->sidtime){
|
||||
#ifdef EE_time
|
||||
JSON("JDate", double_asc(JDate, NULL));
|
||||
str = time_asc(S_time-EE_time);
|
||||
#else
|
||||
str = time_asc(S_time);
|
||||
#endif
|
||||
JSON("S_time", str);
|
||||
}
|
||||
// Telecope mode
|
||||
if(ALL || par->telmode){
|
||||
if(Tel_Hardware == Hard_Off) str = "Off";
|
||||
else if(Tel_Mode != Automatic) str = "Manual";
|
||||
else{
|
||||
switch (Sys_Mode){
|
||||
default:
|
||||
case SysStop : str = "Stopping"; break;
|
||||
case SysWait : str = "Waiting"; break;
|
||||
case SysPointAZ :
|
||||
case SysPointAD : str = "Pointing"; break;
|
||||
case SysTrkStop :
|
||||
case SysTrkStart:
|
||||
case SysTrkMove :
|
||||
case SysTrkSeek : str = "Seeking"; break;
|
||||
case SysTrkOk : str = "Tracking"; break;
|
||||
case SysTrkCorr : str = "Correction";break;
|
||||
case SysTest : str = "Testing"; break;
|
||||
}
|
||||
}
|
||||
JSONSTR("Tel_Mode", str);
|
||||
}
|
||||
// Telescope focus
|
||||
if(ALL || par->telfocus){
|
||||
switch (Tel_Focus){
|
||||
default:
|
||||
case Prime : str = "Prime"; break;
|
||||
case Nasmyth1 : str = "Nasmyth1"; break;
|
||||
case Nasmyth2 : str = "Nasmyth2"; break;
|
||||
}
|
||||
JSONSTR("Tel_Focus", str);
|
||||
JSON("ValFoc", double_asc(val_F, "%0.2f"));
|
||||
}
|
||||
// Telescope target
|
||||
if(ALL || par->target){
|
||||
switch (Sys_Target) {
|
||||
default:
|
||||
case TagObject : str = "Object"; break;
|
||||
case TagPosition : str = "A/Z-Pos."; break;
|
||||
case TagNest : str = "Nest"; break;
|
||||
case TagZenith : str = "Zenith"; break;
|
||||
case TagHorizon : str = "Horizon"; break;
|
||||
}
|
||||
JSONSTR("Tel_Taget", str);
|
||||
}
|
||||
// Mode of P2
|
||||
if(ALL || par->p2mode){
|
||||
if(Tel_Hardware == Hard_On){
|
||||
switch (P2_State) {
|
||||
default:
|
||||
case P2_Off : str = "Stop"; break;
|
||||
case P2_On : str = "Track"; break;
|
||||
case P2_Plus : str = "Move+"; break;
|
||||
case P2_Minus : str = "Move-"; break;
|
||||
}
|
||||
} else str = "Off";
|
||||
JSONSTR("P2_Mode", str);
|
||||
}
|
||||
// Equatorial coordinates
|
||||
if(ALL || par->eqcoor){
|
||||
JSON("CurAlpha", time_asc(CurAlpha));
|
||||
JSON("CurDelta", angle_asc(CurDelta));
|
||||
JSON("SrcAlpha", time_asc(SrcAlpha));
|
||||
JSON("SrcDelta", angle_asc(SrcDelta));
|
||||
JSON("InpAlpha", time_asc(InpAlpha));
|
||||
JSON("InpDelta", angle_asc(InpDelta));
|
||||
JSON("TelAlpha", time_asc(val_Alp));
|
||||
JSON("TelDelta", angle_asc(val_Del));
|
||||
}
|
||||
// Horizontal coordinates
|
||||
if(ALL || par->horcoor){
|
||||
JSON("InpAzim", angle_fmt(InpAzim,"%c%03d:%02d:%04.1f"));
|
||||
JSON("InpZenD", angle_fmt(InpZdist,"%02d:%02d:%04.1f"));
|
||||
JSON("CurAzim", angle_fmt(tag_A,"%c%03d:%02d:%04.1f"));
|
||||
JSON("CurZenD", angle_fmt(tag_Z,"%02d:%02d:%04.1f"));
|
||||
JSON("CurPA", angle_fmt(tag_P,"%03d:%02d:%04.1f"));
|
||||
JSON("SrcPA", angle_fmt(calc_PA(SrcAlpha,SrcDelta,S_time),"%03d:%02d:%04.1f"));
|
||||
JSON("InpPA", angle_fmt(calc_PA(InpAlpha,InpDelta,S_time),"%03d:%02d:%04.1f"));
|
||||
JSON("TelPA", angle_fmt(calc_PA(val_Alp, val_Del, S_time),"%03d:%02d:%04.1f"));
|
||||
}
|
||||
// Values from sensors
|
||||
if(ALL || par->valsens){
|
||||
JSON("ValAzim", angle_fmt(val_A,"%c%03d:%02d:%04.1f"));
|
||||
JSON("ValZenD", angle_fmt(val_Z,"%02d:%02d:%04.1f"));
|
||||
JSON("ValP2", angle_fmt(val_P,"%03d:%02d:%04.1f"));
|
||||
JSON("ValDome", angle_fmt(val_D,"%c%03d:%02d:%04.1f"));
|
||||
}
|
||||
// Differences
|
||||
if(ALL || par->diff){
|
||||
JSON("DiffAzim", angle_fmt(Diff_A,"%c%03d:%02d:%04.1f"));
|
||||
JSON("DiffZenD", angle_fmt(Diff_Z,"%c%02d:%02d:%04.1f"));
|
||||
JSON("DiffP2", angle_fmt(Diff_P,"%c%03d:%02d:%04.1f"));
|
||||
JSON("DiffDome", angle_fmt(val_A-val_D,"%c%03d:%02d:%04.1f"));
|
||||
}
|
||||
// Velocities
|
||||
if(ALL || par->vel){
|
||||
JSON("VelAzim", angle_fmt(vel_A,"%c%02d:%02d:%04.1f"));
|
||||
JSON("VelZenD", angle_fmt(vel_Z,"%c%02d:%02d:%04.1f"));
|
||||
JSON("VelP2", angle_fmt(vel_P,"%c%02d:%02d:%04.1f"));
|
||||
JSON("VelPA", angle_fmt(vel_objP,"%c%02d:%02d:%04.1f"));
|
||||
JSON("VelDome", angle_fmt(vel_D,"%c%02d:%02d:%04.1f"));
|
||||
}
|
||||
// Correction
|
||||
if(ALL || par->corr){
|
||||
double curA,curZ,srcA,srcZ;
|
||||
double corAlp,corDel,corA,corZ;
|
||||
if(Sys_Mode==SysTrkSeek||Sys_Mode==SysTrkOk||Sys_Mode==SysTrkCorr){
|
||||
corAlp = CurAlpha-SrcAlpha;
|
||||
corDel = CurDelta-SrcDelta;
|
||||
if(corAlp > 23*3600.) corAlp -= 24*3600.;
|
||||
if(corAlp < -23*3600.) corAlp += 24*3600.;
|
||||
calc_AZ(SrcAlpha, SrcDelta, S_time, &srcA, &srcZ);
|
||||
calc_AZ(CurAlpha, CurDelta, S_time, &curA, &curZ);
|
||||
corA=curA-srcA;
|
||||
corZ=curZ-srcZ;
|
||||
}else{
|
||||
corAlp = corDel = corA = corZ = 0.;
|
||||
}
|
||||
JSON("CorrAlpha", angle_fmt(corAlp,"%c%01d:%02d:%05.2f"));
|
||||
JSON("CorrDelta", angle_fmt(corDel,"%c%01d:%02d:%04.1f"));
|
||||
JSON("CorrAzim", angle_fmt(corA,"%c%01d:%02d:%04.1f"));
|
||||
JSON("CorrZenD", angle_fmt(corZ,"%c%01d:%02d:%04.1f"));
|
||||
}
|
||||
// meteo
|
||||
if(ALL || par->meteo){
|
||||
JSON("ValTind", double_asc(val_T2, "%05.1f"));
|
||||
JSON("ValTmir", double_asc(val_T3, "%05.1f"));
|
||||
JSON("ValPres", double_asc(val_B, "%05.1f"));
|
||||
JSON("ValWind", double_asc(val_Wnd, "%04.1f"));
|
||||
if(Wnd10_time>0.1 && Wnd10_time<=M_time) {
|
||||
JSON("Blast10", double_asc((M_time-Wnd10_time)/60, "%.1f"));
|
||||
JSON("Blast15", double_asc((M_time-Wnd15_time)/60, "%.1f"));
|
||||
}
|
||||
JSON("ValHumd", double_asc(val_Hmd, "%04.1f"));
|
||||
if(Precip_time>0.1 && Precip_time<=M_time)
|
||||
JSON("Precipt", double_asc((M_time-Precip_time)/60, "%.1f"));
|
||||
}
|
||||
// end of json onject
|
||||
sendstr("\n}\n");
|
||||
}
|
||||
|
||||
|
||||
// ËÏÎÅÃ ÆÁÊÌÁ
|
||||
Reference in New Issue
Block a user