]> rtime.felk.cvut.cz Git - lincan.git/blob - lincan/utils/send.c
Spican1 support added
[lincan.git] / lincan / utils / send.c
1 #include <stdio.h>
2 #include <string.h>
3 #include <fcntl.h>
4 #include <unistd.h>
5 #include <sys/ioctl.h>
6
7 #include "../include/can.h"
8 #define MAXL 40
9
10 int main(void)
11 {
12         int i=0, fd=0, ret=0;
13         unsigned long bits;
14         int msglen;
15         char specialfile[MAXL+1]="/dev/can0", buf[MAXL+1];
16         struct canmsg_t message;
17         unsigned val;
18
19         printf("\nThis program allows you to send  a stream of Can messages.\n");
20         printf("Please answer the following questions:\n\n");
21
22 //              message.flags = 0;
23         message.flags |= MSG_EXT;  //hard code EXT for now
24
25         printf("From wich device file would you like to send the message?\n");
26         printf(specialfile);
27         *buf='\0';
28         fgets(buf,MAXL,stdin);
29         buf[strcspn(buf,"\n")]='\0';
30         if(*buf)
31                 strncpy(specialfile,buf,MAXL);
32         specialfile[MAXL]='\0';
33         printf("Enter the starting Message ID ");
34         scanf("%lx",&message.id);
35         printf("Enter the Message Length ");
36         scanf("%d",&msglen);
37         message.length=msglen;
38         for (i=0; i<message.length; i++) {
39                 printf("Enter data byte [%d] ",i);
40                 scanf("%x",&val);
41                 message.data[i]=val;
42         }
43
44         fd=open(specialfile,O_RDWR);
45         if (fd<0) {
46                 printf("Error opening %s\n",specialfile);
47                 return -1;
48         }
49
50         bits=0;
51         while(1) {
52                 message.flags = MSG_EXT;
53                 message.id++;
54                 message.length %= 8;
55                 message.length++;
56                 bits += 8*(4+message.length);
57                 memcpy(message.data,&bits,sizeof(bits));
58                 ret=write(fd, &message, sizeof(struct canmsg_t));
59                 if (ret<0)
60                         printf("Error sending message from %s\n",specialfile);
61         }
62
63         if (close(fd)) {
64                 printf("Error closing %s\n",specialfile);
65                 return -1;
66         }
67
68         return 0;
69 }