greg@494: /*
greg@494: This file is part of CanFestival, a library implementing CanOpen Stack. 
greg@494: 
greg@494: Copyright (C): Edouard TISSERANT and Francis DUPIN
greg@494: 
greg@494: See COPYING file for copyrights details.
greg@494: 
greg@494: This library is free software; you can redistribute it and/or
greg@494: modify it under the terms of the GNU Lesser General Public
greg@494: License as published by the Free Software Foundation; either
greg@494: version 2.1 of the License, or (at your option) any later version.
greg@494: 
greg@494: This library is distributed in the hope that it will be useful,
greg@494: but WITHOUT ANY WARRANTY; without even the implied warranty of
greg@494: MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
greg@494: Lesser General Public License for more details.
greg@494: 
greg@494: You should have received a copy of the GNU Lesser General Public
greg@494: License along with this library; if not, write to the Free Software
greg@494: Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
greg@494: */
greg@494: 
greg@494: 
greg@494: #include <stdio.h>
greg@494: #include <string.h>
greg@494: #include <errno.h>
greg@494: #include <fcntl.h>
greg@494: 
greg@494: 
greg@494: #include "can_driver.h"
greg@494: 
greg@494: struct SAnaGatePort
greg@494: {
greg@494:    int      hHandle;
greg@494:    Message  sMsgBuffer;
greg@494:    struct   SAnaGatePort *pNext;
greg@494:    struct   SAnaGatePort *pPrev;
greg@494:    int      bBufferFull;
greg@494: };
greg@494: 
greg@494: 
greg@494: struct SAnaGatePort *pFistAnaGatePort = NULL;
greg@494: 
greg@494: 
greg@494: /********* AnaGate API CAN receive callback Funciton  ****************/
greg@494: void AnaGateReceiveCallBack (int nIdentifier, const char* pcBuffer, int nBufferLen, int nFlags, int hHandle)
greg@494: {
greg@494:    int i;
greg@494:    struct SAnaGatePort *pAnaGatePort = pFistAnaGatePort;
greg@494:    
greg@494:    while (pAnaGatePort->hHandle != hHandle )
greg@494:    {
greg@494:       pAnaGatePort = pAnaGatePort->pNext;
greg@494:       if (pAnaGatePort == pFistAnaGatePort )
greg@494:       {
greg@494:          pAnaGatePort = NULL;
greg@494:          printf("AnaGateReceiveCallBack (AnaGate_Linux): ERROR: Can't find AnaGatePort-Objekt to the Received Handle %d\n",hHandle);
greg@494:          return;
greg@494:       }
greg@494:    }
greg@494:    while (pAnaGatePort->bBufferFull)
greg@494:    {
greg@494:       usleep(5000);
greg@494:    }
greg@494:    pAnaGatePort->sMsgBuffer.cob_id =   nIdentifier;
greg@494:    pAnaGatePort->sMsgBuffer.len= nBufferLen;
greg@494:    if (nFlags == 2)
greg@494:     pAnaGatePort->sMsgBuffer.rtr = 1;
greg@494:    else
greg@494:     pAnaGatePort->sMsgBuffer.rtr = 0;
greg@494: 
greg@494:    for (i = 0 ; i < nBufferLen; i++)
greg@494:    {
greg@494:       pAnaGatePort->sMsgBuffer.data[i] = pcBuffer[i];
greg@494:    }
greg@494: 
greg@494:    pAnaGatePort->bBufferFull = 1;
greg@494:  
greg@494: }
greg@494: 
greg@494: 
greg@494: /*********functions which permit to communicate with the board****************/
greg@494: UNS8 canReceive_driver(CAN_HANDLE fd0, Message *m)
greg@494: {
greg@494:    int i;
greg@494:    struct SAnaGatePort*  pAnaGatePort = (struct SAnaGatePort*)fd0;
greg@494: 
greg@494:    while (pAnaGatePort->bBufferFull == 0)
greg@494:    {
greg@494:       usleep (5000); 
greg@494:    }
greg@494:    
greg@494:    m->cob_id = pAnaGatePort->sMsgBuffer.cob_id;
greg@494:    m->len     = pAnaGatePort->sMsgBuffer.len;
greg@494:    m->rtr     = pAnaGatePort->sMsgBuffer.rtr;
greg@494:    for (i = 0 ; i < pAnaGatePort->sMsgBuffer.len; i++)
greg@494:    {
greg@494:      m->data[i] = pAnaGatePort->sMsgBuffer.data[i];
greg@494:    }
greg@494:    
greg@494:    pAnaGatePort->bBufferFull = 0;
greg@494:  
greg@494:    return 0;
greg@494: }
greg@494: 
greg@494: /***************************************************************************/
greg@494: UNS8 canSend_driver(CAN_HANDLE fd0, Message *m)
greg@494: {
greg@494:    struct SAnaGatePort*  pAnaCanPort = (struct SAnaGatePort*)fd0;
greg@494:    char cErrorMsg[100];
greg@494:    int nRetCode;
greg@494:    int nMsgTyp;
greg@494: 
greg@494:    if (m->rtr == 0)
greg@494:    {
greg@494:      nMsgTyp = 0; //Normal;
greg@494:    }
greg@494:    else
greg@494:    {
greg@494:      nMsgTyp = 2; //Remote frame;
greg@494:    }
greg@494: 
greg@494:    if ( (nRetCode = CANWrite(pAnaCanPort->hHandle , m->cob_id,(const char*) m->data, m->len, nMsgTyp) ) )
greg@494:    {
greg@494:      CANErrorMessage( nRetCode, cErrorMsg ,100 ); // Convert returncode to error messge
greg@494:      fprintf(stderr,"canSend_driver (AnaGate_Linux) %s \n",nRetCode);
greg@494:      //printf("canSend_driver (AnaGate_Linux) %s \n",nRetCode);
greg@494:      return 1;
greg@494:    }
greg@494: 
greg@494:    return 0;
greg@494: }
greg@494: 
greg@494: 
greg@494: /***************************************************************************/
greg@494: int TranslateBaudeRate(char* optarg){
greg@494:    if(!strcmp( optarg, "1M"))   return 1000000;
greg@494:    if(!strcmp( optarg, "800K")) return  800000;
greg@494:    if(!strcmp( optarg, "500K")) return  500000;
greg@494:    if(!strcmp( optarg, "250K")) return  250000;
greg@494:    if(!strcmp( optarg, "125K")) return  125000;
greg@494:    if(!strcmp( optarg, "100K")) return  100000;
greg@494:    if(!strcmp( optarg, "50K"))  return   50000;
greg@494:    if(!strcmp( optarg, "20K"))  return   20000;
greg@494:    if(!strcmp( optarg, "10K"))  return   10000;
greg@494:  
greg@494:    return 0x0000;
greg@494: }
greg@494: 
greg@494: /***************************************************************************/
greg@494: UNS8 canChangeBaudRate_driver( CAN_HANDLE fd0, char* baud)
greg@494: {
greg@494:    int nRetCode;
greg@494:    char cErrorMsg[100];
greg@494:    struct SAnaGatePort*  pAnaGatePort = (struct SAnaGatePort*)fd0;
greg@494:    
greg@494:    if (nRetCode = CANSetGlobals (pAnaGatePort->hHandle, TranslateBaudeRate(baud), 0, 0, 1) ) 
greg@494:    {
greg@494:       CANErrorMessage( nRetCode, cErrorMsg ,100 ); // Convert returncode to error messge
greg@494:       fprintf(stderr, "canChangeBaudRate_drive (AnaGate_Linux): %s\n", cErrorMsg);
greg@494:       //printf("canChangeBaudRate_drive (AnaGate_Linux): %s\n", cErrorMsg);
greg@494:       return 1;
greg@494:    }
greg@494:    return 0;
greg@494: }
greg@494: 
greg@494: /***************************************************************************/
greg@494: /* To open a connection to AnaGate CAN the s_BOARD board->busname must be 
greg@494:  the AnaGate IP-Adresse followed from the CAN-Port (A or B) you want to use 
greg@494:  For example "192.168.1.254:A"
greg@494: */
greg@494: 
greg@494: CAN_HANDLE canOpen_driver(s_BOARD *board)
greg@494: {
greg@494:    int nPortNr;
greg@494:    char cErrorMsg[100];
greg@494:    int nRetCode;
greg@494:    char sIPAddress[16];
greg@494:    struct SAnaGatePort *pNewAnaGatePort;
greg@494:    unsigned int nBusnameLen;   
greg@494:    char bBusnameValid = 1;
greg@494: 
greg@494: 
greg@494:    ///////////////////////////////////////////
greg@494:    // Do some checkings concerning the busname
greg@494:    // format should be IP-Adress:Port
greg@494:    // e.g. 192.168.1.254:A
greg@494:    ///////////////////////////////////////////
greg@494:    nBusnameLen = strlen(board->busname);
greg@494:    
greg@494:    if ( nBusnameLen < strlen( "1.2.3.4:A" ) )         bBusnameValid = 0;  // check minimum length of busname
greg@494:    if ( nBusnameLen > strlen( "123.234.345.456:A" ) ) bBusnameValid = 0;  // check maximum length of busname
greg@494:    if ( bBusnameValid )
greg@494:    {
greg@494:       switch (board->busname[nBusnameLen-1])                                 // check Portname of busname
greg@494:       {
greg@494:          case ('A'): nPortNr = 0; break;
greg@494:          case ('B'): nPortNr = 1; break;
greg@494:          case ('C'): nPortNr = 2; break;
greg@494:          case ('D'): nPortNr = 3; break;
greg@494:          default :   bBusnameValid = 0; break;
greg@494:       }
greg@494:       if (board->busname[nBusnameLen-2] != ':' )    bBusnameValid = 0;   // check Colon before Portname
greg@494:    }
greg@494: 
greg@494:    if ( ! bBusnameValid )
greg@494:    {
greg@494:       fprintf(stderr, "canOpen_driver (AnaGate_Win32): busname (\"%s\") has a wrong format. Use IPAddr:CANPort for example \"192.168.1.254:A\"\n",board->busname);
greg@494:       return (CAN_HANDLE) NULL;
greg@494:    }
greg@494: 
greg@494:    board->busname[nBusnameLen-2] = 0; // NULL Terminator for IP Address string
greg@494:    strcpy (sIPAddress, board->busname);
greg@494:    
greg@494:    pNewAnaGatePort = (struct SAnaGatePort*) malloc(sizeof (struct SAnaGatePort));
greg@494:    if (pFistAnaGatePort == NULL)
greg@494:    {
greg@494:       pFistAnaGatePort = pNewAnaGatePort;
greg@494:       pNewAnaGatePort->pNext =  pNewAnaGatePort;
greg@494:       pNewAnaGatePort->pPrev =  pNewAnaGatePort;
greg@494:    }
greg@494:    else
greg@494:    {   pNewAnaGatePort->pNext =  pFistAnaGatePort;
greg@494:       pNewAnaGatePort->pPrev =  pFistAnaGatePort->pPrev;
greg@494:       pFistAnaGatePort->pPrev->pNext = pNewAnaGatePort;
greg@494:       pFistAnaGatePort->pPrev = pNewAnaGatePort;
greg@494: 
greg@494:    }
greg@494: 
greg@494:    // Connect to AnaGate
greg@494:    if ( nRetCode = CANOpenDevice (&pNewAnaGatePort->hHandle, 
greg@494:                         0,      /*confimation off*/ 
greg@494:                         1,      /*Monitor on*/ 
greg@494:                         nPortNr,
greg@494:                         sIPAddress,
greg@494:                         1000   /*TimeOut*/ )  )
greg@494:    {
greg@494:       CANErrorMessage( nRetCode, cErrorMsg ,100 ); // Convert returncode to error messge
greg@494:       fprintf(stderr, "canOpen_driver (AnaGate_Linux): %s @ %s  Port:%d\n", cErrorMsg,sIPAddress,nPortNr);
greg@494:       //printf( "canOpen_driver (AnaGate_Linux): %s @ %s Port:%d\n", cErrorMsg,sIPAddress,nPortNr);
greg@494:       return (CAN_HANDLE) NULL;
greg@494:    }
greg@494:    
greg@494:    // Inizial Baudrate
greg@494: 
greg@494:    if (nRetCode = CANSetGlobals (pNewAnaGatePort->hHandle, 
greg@494:                         TranslateBaudeRate(board->baudrate), 
greg@494:                         0,/*OperatingMode = normal*/ 
greg@494:                         0,/*CAN-Termination = off*/ 
greg@494:                         1 /*HighSpeedMode = on*/) ) 
greg@494:    {
greg@494:       CANErrorMessage( nRetCode, cErrorMsg ,100 ); // Convert returncode to error messge
greg@494:       fprintf(stderr, "canOpen_driver (AnaGate_Linux): %s @ %s\n", cErrorMsg,sIPAddress);
greg@494:       //printf("canOpen_driver (AnaGate_Linux): %s @ %s\n", cErrorMsg,sIPAddress);
greg@494:       return (CAN_HANDLE) NULL;
greg@494:    }
greg@494:    
greg@494:    // Creat receive and receive-acknoledge event 
greg@494:    /*pNewAnaGatePort->hAnaRecEvent = CreateEvent(   
greg@494:                                     NULL,  // default security attributes
greg@494:                                     FALSE, // manual-reset event
greg@494:                                     FALSE, // initial state is nonsignaled
greg@494:                                     NULL  // object name
greg@494:                                     ); 
greg@494: 
greg@494:    pNewAnaGatePort->hFesticalRecAcknowledge = CreateEvent( 
greg@494:                                     NULL,  // default security attributes
greg@494:                                     FALSE, // manual-reset event
greg@494:                                     FALSE, // initial state is nonsignaled
greg@494:                                     NULL   // object name
greg@494:                                     ); 
greg@494:          */
greg@494:  
greg@494:    pNewAnaGatePort->bBufferFull = 0;
greg@494:  
greg@494:    // Install receive callback funktion
greg@494: 
greg@494:    if (nRetCode = CANSetCallback(pNewAnaGatePort->hHandle,  AnaGateReceiveCallBack) ) 
greg@494:    {
greg@494:       canClose_driver (pNewAnaGatePort);
greg@494:       CANErrorMessage( nRetCode, cErrorMsg ,100 ); // Convert returncode to error messge
greg@494:       fprintf(stderr, "canOpen_driver (AnaGate_Linux): %s @ %s\n", cErrorMsg,sIPAddress);
greg@494:       //printf("canOpen_driver (AnaGate_Linux): %s @ %s\n", cErrorMsg,sIPAddress);
greg@494:       return (CAN_HANDLE) NULL;
greg@494:    }
greg@494: 
greg@494: 
greg@494:   return (CAN_HANDLE)pNewAnaGatePort;
greg@494: }
greg@494: 
greg@494: /***************************************************************************/
greg@494: int canClose_driver(CAN_HANDLE fd0)
greg@494: {
greg@494:    struct SAnaGatePort*  pAnaGatePort = (struct SAnaGatePort*)fd0;
greg@494:    char cErrorMsg[100];
greg@494:    int nRetCode;
greg@494: 
greg@494:    pAnaGatePort->bBufferFull = 1;  
greg@494:    
greg@494:    if ( nRetCode = CANCloseDevice(pAnaGatePort->hHandle) )
greg@494:    {
greg@494:      CANErrorMessage( nRetCode, cErrorMsg ,100 ); // Convert returncode to error messge
greg@494:      fprintf(stderr, "canClose_driver (AnaGate_Linux): %s\n", cErrorMsg);
greg@494:      printf("canClose_driver (AnaGate_Linux): %s\n", cErrorMsg);
greg@494:    }
greg@494: 
greg@494:    if (pAnaGatePort->pNext == pAnaGatePort)
greg@494:    {
greg@494:        free (pAnaGatePort);
greg@494:        pFistAnaGatePort=NULL;
greg@494:    }
greg@494:    else
greg@494:    {  
greg@494:       pAnaGatePort->pNext->pPrev = pAnaGatePort->pPrev;
greg@494:       pAnaGatePort->pPrev->pNext = pAnaGatePort->pNext;
greg@494:       free (pAnaGatePort);
greg@494:    }
greg@494: 
greg@494:    return 0;
greg@494: }