drivers/can_peak_linux/can_peak_linux.c
changeset 454 bc000083297a
parent 441 968697561674
child 631 08b6b903f84a
equal deleted inserted replaced
453:c74a73474cce 454:bc000083297a
    22 
    22 
    23 #include <stdio.h>
    23 #include <stdio.h>
    24 #include <string.h>
    24 #include <string.h>
    25 #include <errno.h>
    25 #include <errno.h>
    26 #include <fcntl.h>
    26 #include <fcntl.h>
       
    27 #include <stdlib.h>
    27 
    28 
    28 /* driver pcan pci for Peak board */
    29 /* driver pcan pci for Peak board */
    29 //#include "libpcan.h"
    30 //#include "libpcan.h"
    30 //#include "pcan.h"
    31 //#include "pcan.h"
    31 
    32 
    56   m->len = peakMsg.LEN;					/* count of data bytes (0..8) */
    57   m->len = peakMsg.LEN;					/* count of data bytes (0..8) */
    57   for(data = 0  ; data < peakMsg.LEN ; data++)             			
    58   for(data = 0  ; data < peakMsg.LEN ; data++)             			
    58     m->data[data] = peakMsg.DATA[data];         	/* data bytes, up to 8 */
    59     m->data[data] = peakMsg.DATA[data];         	/* data bytes, up to 8 */
    59 
    60 
    60 #if defined DEBUG_MSG_CONSOLE_ON
    61 #if defined DEBUG_MSG_CONSOLE_ON
    61   printf("in : ");
    62   MSG("in : ");
    62   print_message(m);
    63   print_message(m);
    63 #endif
    64 #endif
    64   
    65   
    65   return 0;
    66   return 0;
    66 }
    67 }
    80           			/* count of data bytes (0..8) */
    81           			/* count of data bytes (0..8) */
    81   for(data = 0 ; data <  m->len; data ++)
    82   for(data = 0 ; data <  m->len; data ++)
    82   	peakMsg.DATA[data] = m->data[data];         	/* data bytes, up to 8 */
    83   	peakMsg.DATA[data] = m->data[data];         	/* data bytes, up to 8 */
    83   
    84   
    84 #if defined DEBUG_MSG_CONSOLE_ON
    85 #if defined DEBUG_MSG_CONSOLE_ON
    85   printf("out : ");
    86   MSG("out : ");
    86   print_message(m);
    87   print_message(m);
    87 #endif
    88 #endif
    88   if((errno = CAN_Write(fd0, & peakMsg))) {
    89   if((errno = CAN_Write(fd0, & peakMsg))) {
    89     perror("canSend_driver (Peak_Linux) : error of writing.\n");
    90     perror("canSend_driver (Peak_Linux) : error of writing.\n");
    90     return 1;
    91     return 1;
   119 CAN_HANDLE canOpen_driver(s_BOARD *board)
   120 CAN_HANDLE canOpen_driver(s_BOARD *board)
   120 {
   121 {
   121   HANDLE fd0 = NULL;
   122   HANDLE fd0 = NULL;
   122   char busname[64];
   123   char busname[64];
   123   char* pEnd;
   124   char* pEnd;
   124   int i;  
       
   125   int baudrate;
   125   int baudrate;
   126   
   126   
   127   if(strtol(board->busname, &pEnd,0) >= 0)
   127   if(strtol(board->busname, &pEnd,0) >= 0)
   128   {
   128   {
   129     sprintf(busname,"/dev/pcan%s",board->busname);
   129     sprintf(busname,"/dev/pcan%s",board->busname);