msg_common.h

/*--------------------------------------
Common head for message queue IPC
--------------------------------------*/
#ifndef __MSG_COMMON_H__
#define __MSG_COMMON_H__

#include <string.h> //strncpy()
#include <stdio.h>
#include <sys/msg.h>
#include <sys/time.h>
#include <errno.h> //-EAGAIN
#include "i2c_oled_128x64.h"

#define MSG_BUFSIZE  64
//---- OLED Display Msg Queue ---
#define MSG_KEY_OLED_TEST 5678 //--- msg queue identical key
#define MSG_TYPE_TING 1  //---msg from ting
#define MSG_TYPE_CC1101 2 //---msg from cc1101
#define MSG_TYPE_WAIT_CC1101 3  //---msg:wait for cc1101 
//----  MOTOR CONTROL Msg Queue -----
#define MSG_KEY_MOTOR 5679 //--msg queue id. key for motor control
#define MSG_TYPE_MOTOR_PWM_WIDTH 1 //--msg type 1
//----  STEERING GEAR Msg Queue -----
#define MSG_KEY_SG 5680 //---msg queue id. key for steering gear 
#define MSG_TYPE_SG_PWM_WIDTH 4 // WARNING !!! msg type also MUST be globally identical

#define TIMER_TV_SEC 1 //10; //(s)  timer routine interval for CC1101 and TING_RX to receive IPC Msg! 
#define TIMER_TV_USEC 0 //(us)  timer routine interval
#define KEEP_RSSI_TIME 10  //(s) keep g_strTingBuf[] and g_strCC1101Buf[] with last received RSSI value if they've not been refreshed within the time limit.
//and fill g_strTingBuf[] and g_strCC1101Buf[] with '-----' when it exceeds the limit.

//----msg_conf.msg_qbytes=sizeof(g_msg_data)*MSG_DATA_BUF_NUM;
#define MSG_DATA_BUF_NUM 64  //
struct g_st_msg
{
	long int msg_type;
	char text[MSG_BUFSIZE];
};

static struct g_st_msg g_msg_data; //message data
static long int msg_type=0; //message type
static  struct msqid_ds msg_conf;//msg configuration set

static int g_msg_id=-1;

//---- timer ----
struct itimerval g_tmval,g_otmval;
//timeval of when last msg received
struct timeval tm_last_msg= \
{
  .tv_sec=0,
  .tv_usec=0,
};
struct timeval tm_now;

//----  info string for CC1101 & Ting
char g_strCC1101Buf[]="CC1101:---------";//---16 characters for one line of oled
char g_strTingBuf[]="T:--------------"; 

/*-------------------------------------------------------
 create message queue and return message queue identifier
-------------------------------------------------------*/
static int createMsgQue(key_t key)
{
  int msg_id=-1;

  //----- create message IPC ------
  msg_id=msgget(key,0666 | IPC_CREAT);
  if(msg_id<0)
  {
        perror("msgget error");
        return msg_id;
   }

  //----!!!! Minimize msg queue size to eliminate accumulation of msg -------
  if(msgctl(msg_id,IPC_STAT,&msg_conf)==0)
  {
        msg_conf.msg_qbytes=sizeof(g_msg_data)*MSG_DATA_BUF_NUM;//!!!!-depend on how many clients will open and send data to it simutaneouly !!!!
        if(msgctl(msg_id,IPC_SET,&msg_conf)==0)
                printf("msgctl: reset msg_conf to allocate  %d messages space in the queue succeed!\n",MSG_DATA_BUF_NUM);
  }
  else
        printf("msgctl: reset msg_conf to allocate %d messages in the queue fails!\n", MSG_DATA_BUF_NUM);

  return msg_id;
}

/*-------------------------------------------------------
get total number of message type in a Msg Queue
return
	>=0   Total numer of message
	-1    Msgctl()  error
-------------------------------------------------------*/
static int getMsgNum(int msg_id)
{
   static struct msqid_ds ds_buf;

   if(msgctl(msg_id,IPC_STAT,&ds_buf)==0)
   {
	return ds_buf.msg_qnum;
   }

   else
   {
	perror("msgctl() to get total number of messages:");
	return -1;
   }

}

/*-------------------------------------------------------
 receive data in message queue with specified message type
 return:
	>0   Number of bytes copied into message buffer
	-1   On error
-------------------------------------------------------*/
static int recvMsgQue(int msg_id,long msg_type)
{
   int msg_ret=-1;

   //?????? need to initialize msg_data ????? 
   //-----get IPC message-----
   msg_ret=msgrcv(msg_id,(void *)&g_msg_data,MSG_BUFSIZE,msg_type,IPC_NOWAIT);  // return number of bytes copied into msg buf
   if(msg_ret == EAGAIN)
   {
//	printf("No message with specified type now.\n");
	return msg_ret;
   }
   if(msg_ret<0) //??? how about =0?
   {
        perror("msgrcv");
        printf("Receive IPC message fails!\n");
        return msg_ret;
   }
   else
   {
        printf("IPC Message received:%s\n",g_msg_data.text);
        return msg_ret;
   }

}


/*-------------------------------------------------------
 send data to  message queue with specified message type
 return 0 if succeed.
-------------------------------------------------------*/
static int sendMsgQue(int msg_id,long msg_type, char *data)
{
    int msg_ret=-1;

//    memset(g_msg_data.text,sizeof(g_msg_data.text),0);
    g_msg_data.msg_type=msg_type;
    strncpy(g_msg_data.text,data,sizeof(g_msg_data.text));
//    printf("start msgsnd()...\n");
    msg_ret=msgsnd(msg_id,(void *)&g_msg_data,MSG_BUFSIZE,IPC_NOWAIT); //non-blocking
    if(msg_ret == EAGAIN)
    {
	printf("Space not available now.\n");
	return msg_ret;
    }
    else if(msg_ret != 0 ) 
    {
         perror("msgsnd failed");
	 return msg_ret;
    }
    return msg_ret;
}



/*-----------------------------
set timer for routine operation
500ms
-------------------------------*/
void initOledTimer(void)
{
   g_tmval.it_value.tv_sec=TIMER_TV_SEC;
   g_tmval.it_value.tv_usec=TIMER_TV_USEC; 
   g_tmval.it_interval.tv_sec=TIMER_TV_SEC;
   g_tmval.it_interval.tv_usec=TIMER_TV_USEC;

   setitimer(ITIMER_REAL,&g_tmval,&g_otmval);
}


/*-----------------------------------------------------
    routine process for Timer in OLED program
-------------------------------------------------------*/
void sigHndlOledTimer(int signo)
{
   int msg_ret;
   char strRSSI[5]={0};

   //------- receive mssage queue from Ting ------
   msg_ret=recvMsgQue(g_msg_id,MSG_TYPE_TING);
   if(msg_ret >0)
   {
/*
        //---get RSSI--
        strncpy(strRSSI,g_msg_data.text+3,4);
        //---put to TING buffer ---
        sprintf(g_strTingBuf,"Ting: %ddBm    ",atoi(strRSSI));
*/
	//--- get count
//        sprintf(g_strTingBuf,"Ting: %d    ",atoi(g_msg_data.text));
        sprintf(g_strTingBuf,"T:%s    ",g_msg_data.text);
	//--- push to Oled frame buff
	push_Oled_Ascii32x18_Buff(g_strTingBuf,2,0);
	//--- record time stamp
	gettimeofday(&tm_last_msg,NULL);
    }
    else if(msg_ret != EAGAIN) //--bypass EAGAIN
    {
	gettimeofday(&tm_now,NULL);
	if((tm_now.tv_sec-tm_last_msg.tv_sec)>KEEP_RSSI_TIME)
	        sprintf(g_strTingBuf,"Ting: --------- ");
    }
    while(msg_ret > 0 ) //---- read out all remaining msg from Ting 
    {
         msg_ret=recvMsgQue(g_msg_id,MSG_TYPE_TING); 
     }

    //------- receive mssage queue from CC1101 ------
    msg_ret=recvMsgQue(g_msg_id,MSG_TYPE_CC1101);  
    if(msg_ret > 0 ){
       	//---put to CC1101 buffer ---
        sprintf(g_strCC1101Buf,"CC1101: %s  ",g_msg_data.text);
	//--- push to Oled frame buff ---
	push_Oled_Ascii32x18_Buff(g_strCC1101Buf,1,0);
    }
    else if(msg_ret != EAGAIN)
          sprintf(g_strCC1101Buf,"CC1101: ------- ");

    while(msg_ret > 0 ) //---- read out all remaining msg from CC1101
    {
         msg_ret=recvMsgQue(g_msg_id,MSG_TYPE_CC1101); 
     }

    //--- send msg to CC1101 to let it send msg ----,for CC1101 sndmsg is much faster than Ting.
    //---- Only if there is enought space left for other applications, in case CC1101_rx is down.
    if(getMsgNum(g_msg_id)<MSG_DATA_BUF_NUM/2)
    		sendMsgQue(g_msg_id,MSG_TYPE_WAIT_CC1101,"wait cc1101");

}

#endif