#include <stdio.h>
#include <stdlib.h>
#include <sys/iofunc.h>
#include <sys/dispatch.h>
#include <string.h> //memset;

//!!!!!!!!!! выравнивание структур нужно задавать везде!!!!!!!!!!
#pragma pack(1)
#include "cdrivercover.h"
extern CDriverCover *cDriverCoverPtr;
//----------
//сигналы
void Signal_Exit(int s_code);//уничтожение процесса
//назначенные функции обработки
int daemon_open(resmgr_context_t *ctp,io_open_t *msg,iofunc_attr_t *attr,void *extra);
int daemon_close_dup(resmgr_context_t* ctp,io_close_t* msg,iofunc_ocb_t* ocb);
int daemon_devctl(resmgr_context_t *ctp,io_devctl_t *msg,iofunc_ocb_t *ocb);
//----------

int main(int argc, char *argv[])
{
 //запускаемся   
 pid_t pid=fork();
 if (pid<0) exit(EXIT_FAILURE);//если ошибка создания - выходим
 if (pid>0) exit(EXIT_SUCCESS);//выходим из родительского процесса
 umask(0);//задаём файловую маску
 //создаём новый SID (идентификатор сессии) для дочернего процесса
 pid_t sid=setsid();
 if (sid<0) exit(EXIT_FAILURE);//ошибка 

 ThreadCtl(_NTO_TCTL_IO,NULL);
 //проверим отсутствие файла устройства
 printf("\n\nStarting CAN driver...\n");
 FILE *file=fopen("/dev/can","rb");
 if (file!=NULL)
 {
  fclose(file);
  printf("Multiple declaration can!\n");
  exit(EXIT_FAILURE);
 }
 cDriverCoverPtr=new CDriverCover("/usr/bin/CANDriver");
 if (cDriverCoverPtr==NULL) exit(EXIT_FAILURE);
 if (cDriverCoverPtr->GetDriverEnabled()==false) exit(EXIT_FAILURE);
 
 //регистрируем драйвер
 dispatch_t *dpp;
 resmgr_attr_t resmgr_attr;
 resmgr_context_t *ctp;
 resmgr_connect_funcs_t connect_func;
 resmgr_io_funcs_t io_func;
 iofunc_attr_t attr;
 if ((dpp=dispatch_create())==NULL)
 {
  //завершение работы
  printf("Error create dispatch !\n");
  printf("CAN driver exit\n");
  exit(EXIT_FAILURE);
 }
 memset(&resmgr_attr,0,sizeof(resmgr_attr));
 resmgr_attr.nparts_max=1;
 resmgr_attr.msg_max_size=65536;
 iofunc_func_init(_RESMGR_CONNECT_NFUNCS,&connect_func,_RESMGR_IO_NFUNCS,&io_func);
 iofunc_attr_init(&attr,S_IFNAM|0666,0,0);
 io_func.devctl=&daemon_devctl;
 connect_func.open=&daemon_open;
 io_func.close_dup=&daemon_close_dup;
 if (resmgr_attach(dpp,&resmgr_attr,"/dev/can",_FTYPE_ANY,0,&connect_func,&io_func,&attr)==-1)
 {
  //завершение работы
  printf("Error registering CAN driver !\n");
  printf("CAN driver exit\n");
  exit(EXIT_FAILURE);
 }
 //подключим сигналы
 signal(SIGINT,Signal_Exit);
 signal(SIGTERM,Signal_Exit);
 signal(SIGKILL,Signal_Exit);
 signal(SIGCLD,Signal_Exit);
 signal(SIGQUIT,Signal_Exit);   
 ctp=resmgr_context_alloc(dpp);
 
  //основной цикл драйвера
 while(1)
 {
  if ((ctp=resmgr_block(ctp))==NULL)
  {
   //просим драйвер завершить работу    
   cDriverCoverPtr->Exit();
   //завершение работы
   printf("Error in regmgr_block !\n");
   printf("CAN driver exit\n");   
   delete(cDriverCoverPtr);
   exit(EXIT_FAILURE);
  }
  resmgr_handler(ctp);
 }
 delete(cDriverCoverPtr);
 exit(EXIT_SUCCESS);
}
//----------
//сигналы
//----------
//уничтожение подчинённого процесса
void Signal_Exit(int s_code)
{
 //просим драйвер завершить работу    
 cDriverCoverPtr->Exit();
 printf("CAN driver exit\n");
 if (cDriverCoverPtr!=NULL) delete(cDriverCoverPtr);
 exit(EXIT_SUCCESS);
}

//----------
//назначенные функции обработки
//----------
int daemon_open(resmgr_context_t *ctp,io_open_t *msg,iofunc_attr_t *attr,void *extra)
{
 if (cDriverCoverPtr==NULL) return(ENOSYS);
 return(cDriverCoverPtr->Open(ctp,msg,attr,extra));   
}
int daemon_close_dup(resmgr_context_t* ctp,io_close_t* msg,iofunc_ocb_t* ocb)
{
 if (cDriverCoverPtr==NULL) return(ENOSYS);
 return(cDriverCoverPtr->CloseDup(ctp,msg,ocb));   
}
int daemon_devctl(resmgr_context_t *ctp,io_devctl_t *msg,iofunc_ocb_t *ocb)
{
 if (cDriverCoverPtr==NULL) return(ENOSYS);
 return(cDriverCoverPtr->DevCtl(ctp,msg,ocb));
}