- Added a sinq module for monitoring the Accelerator broadcast
- Added automatic notification via SMS
This commit is contained in:
koennecke
342
dgrambroadcast.c
Normal file
342
dgrambroadcast.c
Normal file
@ -0,0 +1,342 @@
|
|||||||
|
|
||||||
|
/*
|
||||||
|
* Send UDP multicast message
|
||||||
|
* Send UDP broadcast message
|
||||||
|
*/
|
||||||
|
|
||||||
|
// #define SEND_BCASTS_TOO Yes
|
||||||
|
#ifdef SEND_BCASTS_TOO
|
||||||
|
/* broadcast address for our network */
|
||||||
|
/* unsigned int brAddr = 0x818197ff; - only our network */
|
||||||
|
unsigned int brAddr[] = {
|
||||||
|
0x818197ff, /* 129.129.151.255 */
|
||||||
|
0x818196ff, /* 129.129.150.255 - same router as our subnet */
|
||||||
|
0x81818aff, /* 129.129.138.255 - same router as our subnet */
|
||||||
|
};
|
||||||
|
int nrBrAddr = sizeof(brAddr) / sizeof(unsigned int);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
#include <sys/types.h>
|
||||||
|
#include <sys/time.h>
|
||||||
|
#include <sys/socket.h>
|
||||||
|
#include <netinet/in.h>
|
||||||
|
#include <net/if.h>
|
||||||
|
#include <arpa/inet.h>
|
||||||
|
#include <netdb.h>
|
||||||
|
|
||||||
|
#ifndef vaxc
|
||||||
|
# ifndef HP_RT
|
||||||
|
# ifndef __osf__
|
||||||
|
# ifndef linux
|
||||||
|
# include <sys/sockio.h>
|
||||||
|
# endif
|
||||||
|
# endif
|
||||||
|
# else
|
||||||
|
# include <sys/ioctl.h>
|
||||||
|
# endif
|
||||||
|
#else
|
||||||
|
# include <UCX$INETDEF.H>
|
||||||
|
#endif
|
||||||
|
|
||||||
|
|
||||||
|
/* #define TESTING Yes */
|
||||||
|
|
||||||
|
#ifdef TESTING
|
||||||
|
#define PERROR(x) perror(x)
|
||||||
|
#else
|
||||||
|
#define PERROR(x)
|
||||||
|
#endif
|
||||||
|
|
||||||
|
|
||||||
|
#include "dgrambroadcast.h"
|
||||||
|
|
||||||
|
|
||||||
|
int McastSocket; /* multicast socket */
|
||||||
|
struct sockaddr_in McastDestination; /* multicast destination address */
|
||||||
|
|
||||||
|
|
||||||
|
/*********************************************************************/
|
||||||
|
|
||||||
|
// -DDESTINATION_MCAST="\"226.129.151.57\""
|
||||||
|
// which is acs-gateway with first byte replaced to 226
|
||||||
|
|
||||||
|
static char DESTINATION_MCAST[128] = {0}; // place to hold x.y.z.w IPv4 address
|
||||||
|
|
||||||
|
void initDestMcastAddr()
|
||||||
|
{
|
||||||
|
struct hostent *hp;
|
||||||
|
|
||||||
|
if (memcmp(DESTINATION_MCAST, "226.", 4) == 0) {
|
||||||
|
return; // already initialized
|
||||||
|
}
|
||||||
|
|
||||||
|
hp = gethostbyname(SERVER_HOST);
|
||||||
|
if (hp == (struct hostent *) 0) {
|
||||||
|
printf("%s: unknown host", SERVER_HOST);
|
||||||
|
exit(99);
|
||||||
|
}
|
||||||
|
|
||||||
|
sprintf(DESTINATION_MCAST, "226.%d.%d.%d", hp->h_addr[1]&0xFF, hp->h_addr[2]&0xFF, hp->h_addr[3]&0xFF);
|
||||||
|
//printf("Got DESTINATION_MCAST = '%s'\n", DESTINATION_MCAST);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*********************************************************************/
|
||||||
|
void closeBroadcastSocket(sendSocket)
|
||||||
|
int sendSocket;
|
||||||
|
{
|
||||||
|
#ifdef TESTING
|
||||||
|
printf("closeBroadcastSocket()\n");
|
||||||
|
#endif
|
||||||
|
close(sendSocket);
|
||||||
|
|
||||||
|
if (McastSocket >= 0) close(McastSocket);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
/*********************************************************************/
|
||||||
|
int openBroadcastSocket()
|
||||||
|
{
|
||||||
|
//unsigned char ttl;
|
||||||
|
int ttl;
|
||||||
|
int sendSocket;
|
||||||
|
int enableBroadcast;
|
||||||
|
|
||||||
|
int status;
|
||||||
|
|
||||||
|
|
||||||
|
initDestMcastAddr();
|
||||||
|
|
||||||
|
#ifdef TESTING
|
||||||
|
printf("openBroadcastSocket()\n");
|
||||||
|
#endif
|
||||||
|
|
||||||
|
sendSocket = socket(AF_INET, SOCK_DGRAM, 0);
|
||||||
|
if (sendSocket < 0) {
|
||||||
|
PERROR("socket");
|
||||||
|
return sendSocket;
|
||||||
|
}
|
||||||
|
|
||||||
|
enableBroadcast = 1;
|
||||||
|
status = setsockopt(sendSocket, SOL_SOCKET, SO_BROADCAST, (char *) &enableBroadcast, sizeof(enableBroadcast));
|
||||||
|
if (status < 0) {
|
||||||
|
PERROR("setsockopt");
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
/* open multicast socket */
|
||||||
|
McastSocket = socket(AF_INET, SOCK_DGRAM, 0);
|
||||||
|
if (McastSocket < 0) {
|
||||||
|
PERROR("McastSocket");
|
||||||
|
}
|
||||||
|
//else { printf("Multicast socket opened\n");}
|
||||||
|
|
||||||
|
ttl = 4; // with less then 2 it does not work
|
||||||
|
if(setsockopt(McastSocket, IPPROTO_IP, IP_MULTICAST_TTL, (char *) &ttl, sizeof(ttl)) < 0) {
|
||||||
|
perror("setsockopt() failed setting IP_MULTICAST_TTL");
|
||||||
|
}
|
||||||
|
//else {printf("Multicast socket configured\n");}
|
||||||
|
|
||||||
|
McastDestination.sin_family = AF_INET;
|
||||||
|
McastDestination.sin_port = htons(SEND_PORT);
|
||||||
|
McastDestination.sin_addr.s_addr = inet_addr(DESTINATION_MCAST);
|
||||||
|
|
||||||
|
|
||||||
|
return sendSocket;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
/*********************************************************************/
|
||||||
|
int openReceiveSocket(port)
|
||||||
|
unsigned short port;
|
||||||
|
{
|
||||||
|
struct sockaddr_in name;
|
||||||
|
int recvSocket;
|
||||||
|
|
||||||
|
initDestMcastAddr();
|
||||||
|
|
||||||
|
#ifdef TESTING
|
||||||
|
printf("openReceiveSocket()\n");
|
||||||
|
#endif
|
||||||
|
|
||||||
|
recvSocket = socket(AF_INET, SOCK_DGRAM, 0);
|
||||||
|
if (recvSocket < 0) {
|
||||||
|
PERROR("socket");
|
||||||
|
return recvSocket;
|
||||||
|
}
|
||||||
|
|
||||||
|
{
|
||||||
|
int sopt = 1;
|
||||||
|
|
||||||
|
if (setsockopt(recvSocket, SOL_SOCKET, SO_REUSEADDR, (char *) &sopt, sizeof(int)) != 0) {
|
||||||
|
perror("SO_REUSEADDR");
|
||||||
|
printf("not fatal, continuing\n");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Create name with wildcards. */
|
||||||
|
name.sin_family = AF_INET;
|
||||||
|
name.sin_addr.s_addr = INADDR_ANY;
|
||||||
|
name.sin_port = htons(port);
|
||||||
|
if (bind(recvSocket, (struct sockaddr *) &name, sizeof(name))) {
|
||||||
|
PERROR("bind");
|
||||||
|
recvSocket = -1;
|
||||||
|
return recvSocket;
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifdef USE_MULTICAST
|
||||||
|
{
|
||||||
|
char group[100]; // group address string
|
||||||
|
struct ip_mreq McastReq; // multicast group request
|
||||||
|
|
||||||
|
printf("Receive on port 0x%04X=%d, use multicast group=\"%s\" addr=INADDR_ANY\n",
|
||||||
|
port & 0xFFFF, port, DESTINATION_MCAST);
|
||||||
|
|
||||||
|
// Join the multicast group from we want to receive datagrams.
|
||||||
|
// Initialize the multicast request structure and then pass
|
||||||
|
// it as an option to setsockopt(). The imr_multiaddr element
|
||||||
|
// is initialized to the desired multicast group. The
|
||||||
|
// imr_interface element is initilized to IPADDR_ANY which
|
||||||
|
// causes the multcast receives to come from the default
|
||||||
|
// interface.
|
||||||
|
|
||||||
|
// Set defaults and get group address and port number if
|
||||||
|
// specified in command line.
|
||||||
|
strcpy(group, DESTINATION_MCAST );
|
||||||
|
|
||||||
|
McastReq.imr_multiaddr.s_addr = inet_addr(group);
|
||||||
|
McastReq.imr_interface.s_addr = INADDR_ANY;
|
||||||
|
|
||||||
|
if(setsockopt(recvSocket, IPPROTO_IP, IP_ADD_MEMBERSHIP, (char *) &McastReq, sizeof(McastReq)) < 0)
|
||||||
|
perror("setsockopt failed for IP_ADD_MEMBERSHIP");
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
return recvSocket;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
/*********************************************************************/
|
||||||
|
void receiveJoinMCast(recvSocket)
|
||||||
|
int recvSocket;
|
||||||
|
{
|
||||||
|
struct ip_mreq McastReq; // multicast group request
|
||||||
|
char *group;
|
||||||
|
|
||||||
|
|
||||||
|
initDestMcastAddr();
|
||||||
|
|
||||||
|
group = DESTINATION_MCAST;
|
||||||
|
|
||||||
|
|
||||||
|
McastReq.imr_multiaddr.s_addr = inet_addr(group);
|
||||||
|
McastReq.imr_interface.s_addr = INADDR_ANY;
|
||||||
|
|
||||||
|
if(setsockopt(recvSocket, IPPROTO_IP, IP_ADD_MEMBERSHIP, (char *) &McastReq, sizeof(McastReq)) < 0)
|
||||||
|
perror("setsockopt failed for IP_ADD_MEMBERSHIP");
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
/*********************************************************************/
|
||||||
|
int selectReceiveSocket(recvSocket, usec)
|
||||||
|
int recvSocket;
|
||||||
|
int usec;
|
||||||
|
{
|
||||||
|
struct timeval tv;
|
||||||
|
int nfds, rm, wm, em;
|
||||||
|
int status;
|
||||||
|
|
||||||
|
#ifdef TESTING
|
||||||
|
printf("selectReceiveSocket()\n");
|
||||||
|
#endif
|
||||||
|
|
||||||
|
nfds = 32;
|
||||||
|
rm = 1 << recvSocket;
|
||||||
|
wm = 0;
|
||||||
|
em = 0;
|
||||||
|
tv.tv_sec = 0;
|
||||||
|
tv.tv_usec = usec;
|
||||||
|
|
||||||
|
#ifndef vaxc
|
||||||
|
status = select(nfds, (fd_set *) &rm, (fd_set *) &wm, (fd_set *) &em, &tv);
|
||||||
|
#else
|
||||||
|
status = select(nfds, &rm, &wm, &em, &tv);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
return status; /* 0 = nothing to read, 1 = ready for read, -1 = error */
|
||||||
|
}
|
||||||
|
|
||||||
|
int readReceiveSocket(recvSocket, buff, len)
|
||||||
|
int recvSocket;
|
||||||
|
unsigned char *buff;
|
||||||
|
int len;
|
||||||
|
{
|
||||||
|
int status;
|
||||||
|
|
||||||
|
#ifdef TESTING
|
||||||
|
printf("readReceiveSocket()\n");
|
||||||
|
#endif
|
||||||
|
|
||||||
|
memset(buff, '\0', len);
|
||||||
|
status = read(recvSocket, buff, len);
|
||||||
|
if (status < 0) PERROR("read");
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*********************************************************************/
|
||||||
|
int sendBroadcastMessage(sendSocket, sendPort, sndMsg, sndMsgLen)
|
||||||
|
int sendSocket;
|
||||||
|
unsigned short sendPort;
|
||||||
|
unsigned char *sndMsg;
|
||||||
|
int sndMsgLen;
|
||||||
|
{
|
||||||
|
int status;
|
||||||
|
#ifdef SEND_BCASTS_TOO
|
||||||
|
int i;
|
||||||
|
int flags;
|
||||||
|
struct sockaddr_in sendName;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
|
||||||
|
#ifdef TESTING
|
||||||
|
printf("sendBroadcastMessage(s=%d, 0x%04X, msg, len=%d)\n", sendSocket, sendPort, sndMsgLen);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* send multicast message */
|
||||||
|
status = sendto(McastSocket, (char *) sndMsg, sndMsgLen, 0, (struct sockaddr *) &McastDestination, sizeof(McastDestination));
|
||||||
|
return status;
|
||||||
|
|
||||||
|
|
||||||
|
#ifdef SEND_BCASTS_TOO
|
||||||
|
/* send to all broadcast addresses from the list */
|
||||||
|
for (i = 0; i < nrBrAddr; i++) {
|
||||||
|
|
||||||
|
sendName.sin_family = AF_INET;
|
||||||
|
sendName.sin_addr.s_addr = htonl(brAddr[i]);
|
||||||
|
sendName.sin_port = htons(sendPort);
|
||||||
|
|
||||||
|
flags = 0;
|
||||||
|
status = sendto(sendSocket, (char *) sndMsg, sndMsgLen,
|
||||||
|
flags, (struct sockaddr *) &sendName,
|
||||||
|
sizeof(sendName));
|
||||||
|
|
||||||
|
if (status != sndMsgLen) {
|
||||||
|
/*printf("sendBroadcastMessage(s=%d, 0x%04X, msg, len=%d - FAILED)\n", brAddr[i], sendPort, sndMsgLen);*/
|
||||||
|
PERROR("sendto");
|
||||||
|
}
|
||||||
|
/*else{printf("sendBroadcastMessage(s=%d, 0x%04X, msg, len=%d - OK)\n", brAddr[i], sendPort, sndMsgLen);}*/
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
|
||||||
|
return status;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
11
dgrambroadcast.h
Normal file
11
dgrambroadcast.h
Normal file
@ -0,0 +1,11 @@
|
|||||||
|
|
||||||
|
#define MAX_BROADCAST_MSG_LEN 1472
|
||||||
|
|
||||||
|
int openBroadcastSocket ( /* void */ );
|
||||||
|
void closeBroadcastSocket( /* sendSocket */ );
|
||||||
|
int sendBroadcastMessage( /* sendSocket, sendPort, sndMsg, sndMsgLen */ );
|
||||||
|
|
||||||
|
int openReceiveSocket ( /* port */ );
|
||||||
|
int readReceiveSocket ( /* recvSocket, buff, len */ );
|
||||||
|
int selectReceiveSocket ( /* recvSocket, usec */ );
|
||||||
|
|
||||||
11
make_gen
11
make_gen
@ -16,8 +16,8 @@ OBJ=psi.o buffer.o ruli.o dmc.o nxsans.o nextrics.o sps.o pimotor.o \
|
|||||||
el755driv.o amorscan.o serial.o scontroller.o t_update.o \
|
el755driv.o amorscan.o serial.o scontroller.o t_update.o \
|
||||||
t_rlp.o t_conv.o el737hpdriv.o dornier2.o el734hp.o \
|
t_rlp.o t_conv.o el737hpdriv.o dornier2.o el734hp.o \
|
||||||
el737hpv2driv.o swmotor2.o tricssupport.o \
|
el737hpv2driv.o swmotor2.o tricssupport.o \
|
||||||
oicom.o fsm.o remob.o eve.o logger.o \
|
oicom.o fsm.o remob.o eve.o logger.o dgrambroadcast.o \
|
||||||
ipsdriv.o itcdriv.o ilmdriv.o lcdriv.o
|
ipsdriv.o itcdriv.o ilmdriv.o lcdriv.o sinq.o
|
||||||
|
|
||||||
libpsi.a: $(OBJ)
|
libpsi.a: $(OBJ)
|
||||||
rm -f libpsi.a
|
rm -f libpsi.a
|
||||||
@ -27,3 +27,10 @@ libpsi.a: $(OBJ)
|
|||||||
clean:
|
clean:
|
||||||
rm -f *.a
|
rm -f *.a
|
||||||
rm -f *.o
|
rm -f *.o
|
||||||
|
|
||||||
|
SINQOPT=-DGRAPH_MHC3 -DUSE_MULTICAST -DSEND_PORT=0xABCB -DSERVER_HOST="\"acslg1\""
|
||||||
|
dgrambroadcast.o: dgrambroadcast.h dgrambroadcast.c
|
||||||
|
$(CC) $(SINQOPT) -c -g dgrambroadcast.c
|
||||||
|
|
||||||
|
sinq.o: sinq.c sinq.h dgrambroadcast.h
|
||||||
|
$(CC) $(SINQOPT) -I../ -g -c sinq.c
|
||||||
|
|||||||
3
psi.c
3
psi.c
@ -51,6 +51,7 @@
|
|||||||
#include "fomerge.h"
|
#include "fomerge.h"
|
||||||
#include "remob.h"
|
#include "remob.h"
|
||||||
#include "tricssupport.h"
|
#include "tricssupport.h"
|
||||||
|
#include "sinq.h"
|
||||||
|
|
||||||
static pSite sitePSI = NULL;
|
static pSite sitePSI = NULL;
|
||||||
|
|
||||||
@ -81,6 +82,7 @@ static void AddPsiCommands(SicsInterp *pInter){
|
|||||||
AddCommand(pInter,"InstallFocusMerge",InstallFocusMerge,NULL,NULL);
|
AddCommand(pInter,"InstallFocusMerge",InstallFocusMerge,NULL,NULL);
|
||||||
AddCommand(pInter,"Remob",RemobCreate,NULL,NULL);
|
AddCommand(pInter,"Remob",RemobCreate,NULL,NULL);
|
||||||
AddCommand(pInter,"Graph",LoggerGraph,NULL,NULL);
|
AddCommand(pInter,"Graph",LoggerGraph,NULL,NULL);
|
||||||
|
AddCommand(pInter,"MakeSinq",SinqFactory,NULL,NULL);
|
||||||
/*
|
/*
|
||||||
AddCommand(pInter,"MakeDifrac",MakeDifrac,NULL,NULL);
|
AddCommand(pInter,"MakeDifrac",MakeDifrac,NULL,NULL);
|
||||||
*/
|
*/
|
||||||
@ -109,6 +111,7 @@ static void RemovePsiCommands(SicsInterp *pSics){
|
|||||||
RemoveCommand(pSics,"MakeECB");
|
RemoveCommand(pSics,"MakeECB");
|
||||||
RemoveCommand(pSics,"MakePSDFrame");
|
RemoveCommand(pSics,"MakePSDFrame");
|
||||||
RemoveCommand(pSics,"SerialInit");
|
RemoveCommand(pSics,"SerialInit");
|
||||||
|
RemoveCommand(pSics,"MakeSinq");
|
||||||
}
|
}
|
||||||
/*---------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------*/
|
||||||
MotorDriver *CreateEL734(SConnection *pCon, int argc, char *argv[]);
|
MotorDriver *CreateEL734(SConnection *pCon, int argc, char *argv[]);
|
||||||
|
|||||||
201
sinq.c
Normal file
201
sinq.c
Normal file
@ -0,0 +1,201 @@
|
|||||||
|
/*--------------------------------------------------------------------------
|
||||||
|
* A module which reads the broadcast messages from the PSI Accelerator group
|
||||||
|
* and allows to use the information in them in SICS. This facility runs
|
||||||
|
* as a SICS task which tries to read incoming messages and stores the
|
||||||
|
* messages of interest in an internal data structure. Some code is provided
|
||||||
|
* to make the content of these messages available within SICS. This code
|
||||||
|
* follows very closely the DoesItComeMC program from Demir Anici
|
||||||
|
*
|
||||||
|
* The module also holds a circular backlog of the last MAXLOG measurements.
|
||||||
|
* This is used in order to calulcate an average.
|
||||||
|
*
|
||||||
|
* copyright: see file COPYRIGHT
|
||||||
|
*
|
||||||
|
* Mark Koennecke, July 2005
|
||||||
|
*/
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
#include <sys/types.h>
|
||||||
|
#include <sys/time.h>
|
||||||
|
#include <sys/socket.h>
|
||||||
|
#include <netinet/in.h>
|
||||||
|
#include <arpa/inet.h>
|
||||||
|
#include "dgrambroadcast.h"
|
||||||
|
|
||||||
|
#include "sinq.h"
|
||||||
|
#ifdef SEND_PORT
|
||||||
|
#define RECEIVE_PORT SEND_PORT
|
||||||
|
#else
|
||||||
|
#define RECEIVE_PORT 0xABCC
|
||||||
|
#endif
|
||||||
|
#define MAX_BLEN 2048
|
||||||
|
/*====================== life and death =====================================*/
|
||||||
|
static int SinqTask(void *data){
|
||||||
|
pSinq self = (pSinq)data;
|
||||||
|
char buff[MAX_BLEN];
|
||||||
|
int status, sinq;
|
||||||
|
|
||||||
|
if(self == NULL){
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
status = selectReceiveSocket(self->receiveSocket, 0);
|
||||||
|
if(status <= 0){
|
||||||
|
/*
|
||||||
|
* no pending message
|
||||||
|
*/
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
memset(buff,0,MAX_BLEN);
|
||||||
|
status = read(self->receiveSocket, buff, MAX_BLEN);
|
||||||
|
if(status < 0) {
|
||||||
|
ServerWriteGlobal("WARNING: failed to read Sinq Status",eWarning);
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
if(memcmp(buff,"D110",4) == 0){
|
||||||
|
strcpy(self->d110,buff);
|
||||||
|
sinq = getSinqBeam(self,SINQBEAM);
|
||||||
|
self->lastSinq[self->lastCount] = sinq;
|
||||||
|
self->lastCount++;
|
||||||
|
if(self->lastCount >= MAXLOG){
|
||||||
|
self->lastCount = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if(memcmp(buff,"A110",4) == 0){
|
||||||
|
strcpy(self->a110,buff);
|
||||||
|
}
|
||||||
|
/*
|
||||||
|
* ignore any other message
|
||||||
|
*/
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
/*------------------------------------------------------------------------*/
|
||||||
|
static void KillSinq(void *data){
|
||||||
|
pSinq self = (pSinq)data;
|
||||||
|
if(self == NULL){
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
if(self->pDes != NULL){
|
||||||
|
DeleteDescriptor(self->pDes);
|
||||||
|
}
|
||||||
|
free(self);
|
||||||
|
}
|
||||||
|
/*-------------------------------------------------------------------------*/
|
||||||
|
int SinqFactory(SConnection *pCon, SicsInterp *pSics,
|
||||||
|
void *pData, int argc, char *argv[]){
|
||||||
|
pSinq pNew = NULL;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
pNew = (pSinq)malloc(sizeof(Sinq));
|
||||||
|
if(pNew == NULL){
|
||||||
|
SCWrite(pCon,"ERROR: out of memory allocating Sinq",eError);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
memset(pNew,0,sizeof(Sinq));
|
||||||
|
pNew->pDes = CreateDescriptor("Sinq");
|
||||||
|
if(pNew->pDes == NULL){
|
||||||
|
SCWrite(pCon,"ERROR: out of memory allocating Sinq",eError);
|
||||||
|
free(pNew);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
pNew->receiveSocket = openReceiveSocket(RECEIVE_PORT);
|
||||||
|
if(pNew->receiveSocket < 0){
|
||||||
|
SCWrite(pCon,"ERROR: failed to open Sinq Status Broadcast port",
|
||||||
|
eError);
|
||||||
|
KillSinq(pNew);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
for(i = 0; i < MAXLOG; i++){
|
||||||
|
pNew->lastSinq[i] = -200;
|
||||||
|
}
|
||||||
|
TaskRegister(pServ->pTasker,SinqTask,
|
||||||
|
NULL,
|
||||||
|
NULL,
|
||||||
|
pNew,
|
||||||
|
1);
|
||||||
|
return AddCommand(pSics,"sinq",SinqWrapper,
|
||||||
|
KillSinq,
|
||||||
|
pNew);
|
||||||
|
}
|
||||||
|
/*===================== actual Action ====================================*/
|
||||||
|
extern char *trim(char *txt);
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
int getSinqBeam(pSinq self, int code){
|
||||||
|
int result, i;
|
||||||
|
char *pPtr;
|
||||||
|
|
||||||
|
if(self == NULL) {
|
||||||
|
return -900;
|
||||||
|
}
|
||||||
|
switch(code){
|
||||||
|
case SINQBEAM:
|
||||||
|
pPtr = strstr(&self->d110[4],"MHC6");
|
||||||
|
break;
|
||||||
|
case RINGBEAM:
|
||||||
|
pPtr = strstr(&self->d110[4],"MHC3");
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
return -900;
|
||||||
|
}
|
||||||
|
if(pPtr == NULL){
|
||||||
|
printf("Invalid Sinq message: %s\n",&self->d110[4]);
|
||||||
|
return -900;
|
||||||
|
}
|
||||||
|
pPtr = strstr(pPtr,":");
|
||||||
|
if(pPtr == NULL){
|
||||||
|
return -900;
|
||||||
|
}
|
||||||
|
pPtr++;
|
||||||
|
/*
|
||||||
|
* zero out units
|
||||||
|
*/
|
||||||
|
for(i = strlen(pPtr); i > 0; i--){
|
||||||
|
if(isdigit(pPtr[i])){
|
||||||
|
break;
|
||||||
|
} else {
|
||||||
|
pPtr[i] = '\0';
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return atoi(trim(pPtr));
|
||||||
|
}
|
||||||
|
/*-------------------------------------------------------------------------*/
|
||||||
|
int SinqWrapper(SConnection *pCon, SicsInterp *pSics,
|
||||||
|
void *pData, int argc, char *argv[]){
|
||||||
|
pSinq self = (pSinq)pData;
|
||||||
|
char pBueffel[132];
|
||||||
|
int sum, count, i, avg;
|
||||||
|
|
||||||
|
|
||||||
|
assert(self != NULL);
|
||||||
|
|
||||||
|
if(argc < 2) {
|
||||||
|
SCWrite(pCon,&self->a110[4],eValue);
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
strtolower(argv[1]);
|
||||||
|
if(strcmp(argv[1],"beam") == 0){
|
||||||
|
snprintf(pBueffel,131,"sinq.beam = %d", getSinqBeam(self,SINQBEAM));
|
||||||
|
} else if(strcmp(argv[1],"ring") == 0){
|
||||||
|
snprintf(pBueffel,131,"sinq.ring = %d", getSinqBeam(self,RINGBEAM));
|
||||||
|
} else if(strcmp(argv[1],"beamavg") == 0){
|
||||||
|
for(i = 0, count = 0, sum = 0; i < MAXLOG; i++){
|
||||||
|
if(self->lastSinq[i] > -50) {
|
||||||
|
count++;
|
||||||
|
sum += self->lastSinq[i];
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if(count > 0){
|
||||||
|
avg = sum/count;
|
||||||
|
} else {
|
||||||
|
avg = 0;
|
||||||
|
}
|
||||||
|
snprintf(pBueffel,131,"sinq.beamavg = %d", avg);
|
||||||
|
} else{
|
||||||
|
SCWrite(pCon,"ERROR: invalid key, I understand: beam, ring",eError);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
SCWrite(pCon,pBueffel,eValue);
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
42
sinq.h
Normal file
42
sinq.h
Normal file
@ -0,0 +1,42 @@
|
|||||||
|
/*--------------------------------------------------------------------------
|
||||||
|
* A module which reads the broadcast messages from the PSI Accelerator group
|
||||||
|
* and allows to use the information in them in SICS. This facility runs
|
||||||
|
* as a SICS task which tries to read incoming messages and stores the
|
||||||
|
* messages of interest in an internal data structure. Some code is provided
|
||||||
|
* to make the content of these messages available within SICS.
|
||||||
|
*
|
||||||
|
* copyright: see file COPYRIGHT
|
||||||
|
*
|
||||||
|
* Mark Koennecke, July 2005
|
||||||
|
*/
|
||||||
|
#ifndef _SINQ_H_
|
||||||
|
#define _SINQ_H_
|
||||||
|
#include <sics.h>
|
||||||
|
/*-------------------------------------------------------------------------*/
|
||||||
|
#define MAXLOG 300
|
||||||
|
/*-------------------------------------------------------------------------*/
|
||||||
|
typedef struct {
|
||||||
|
pObjectDescriptor pDes;
|
||||||
|
char d110[2024];
|
||||||
|
char a110[2024];
|
||||||
|
int receiveSocket;
|
||||||
|
int lastSinq[MAXLOG];
|
||||||
|
int lastCount;
|
||||||
|
}Sinq, *pSinq;
|
||||||
|
/*----------------------- interpreter interface ------------------------*/
|
||||||
|
int SinqFactory(SConnection *pCon, SicsInterp *pSics,
|
||||||
|
void *pData, int argc, char *argv[]);
|
||||||
|
int SinqWrapper(SConnection *pCon, SicsInterp *pSics,
|
||||||
|
void *pData, int argc, char *argv[]);
|
||||||
|
/*-------------------------------------------------------------------------*/
|
||||||
|
#define SINQBEAM 1
|
||||||
|
#define RINGBEAM 2
|
||||||
|
/**
|
||||||
|
* get the SINQ beam intensity.
|
||||||
|
* @param self A pointer to the SINQ data structure
|
||||||
|
* @param code either SINQBEAM or RINGBEAM
|
||||||
|
* @return The last read intensity of the appropriate beam or -900 on error
|
||||||
|
*/
|
||||||
|
int getSinqBeam(pSinq self, int code);
|
||||||
|
|
||||||
|
#endif //_SINQ_H_
|
||||||
Reference in New Issue
Block a user