Commit 2dcf20ecf2e7bf3a6f6006a41186ef60946a81c7
1 parent
43960e63
first program withour button control
Showing
10 changed files
with
303 additions
and
0 deletions
Show diff stats
No preview for this file type
... | ... | @@ -0,0 +1,150 @@ |
1 | +/* | |
2 | + * Very basic emulation of an Arduino UNO with some buttons and some LEDs | |
3 | + */ | |
4 | + | |
5 | +//// | |
6 | +// Include files | |
7 | +//// | |
8 | +#include <stdio.h> | |
9 | +#include <stdlib.h> | |
10 | +#include <unistd.h> | |
11 | +#include <string.h> | |
12 | +#include <sys/poll.h> | |
13 | +#include <sys/time.h> | |
14 | + | |
15 | +#include "virtual_serial.h" | |
16 | +#include "arduino.h" | |
17 | + | |
18 | +//// | |
19 | +// Constants | |
20 | +//// | |
21 | +#define SERIAL_SPEED 9600 | |
22 | +#define SLEEP_DELAY 100 | |
23 | + | |
24 | +#define MAX_NAME 1024 | |
25 | +#define MAX_LINE 1024 | |
26 | +#define MAX_SERIAL 1024 | |
27 | + | |
28 | +//// | |
29 | +// Global variables | |
30 | +//// | |
31 | + | |
32 | +//// | |
33 | +// Utility functions | |
34 | +//// | |
35 | + | |
36 | +static unsigned char ledstates[LEDS_NB]; | |
37 | +void led(int num,unsigned char state){ | |
38 | +if(num>=0 && num<LEDS_NB) ledstates[num]=state; | |
39 | +int i; | |
40 | +printf(" LEDs: "); | |
41 | +for(i=0;i<LEDS_NB;i++) printf("[%c] ",ledstates[i]?'X':' '); | |
42 | +printf("\r"); | |
43 | +fflush(stdout); | |
44 | +} | |
45 | + | |
46 | +static unsigned char outbuf[MAX_SERIAL]; | |
47 | +int outsize=0; | |
48 | +void serialSend(unsigned char *data,int size){ | |
49 | +if(size+outsize<MAX_SERIAL){ | |
50 | + memcpy(outbuf+outsize,data,size); | |
51 | + } | |
52 | +} | |
53 | + | |
54 | +static unsigned char butstates[BUTTONS_NB]; | |
55 | +static void _button(int num,unsigned char state){ | |
56 | +if(num>=0 && num<BUTTONS_NB) butstates[num]=state; | |
57 | +int i; | |
58 | +printf("Buttons: "); | |
59 | +for(i=0;i<BUTTONS_NB;i++) printf("[%c] ",(butstates[i]?'A':'a')+i); | |
60 | +printf("\n"); | |
61 | +} | |
62 | + | |
63 | +unsigned char button(int num){ | |
64 | +if(num>=0 && num<BUTTONS_NB) return butstates[num]; | |
65 | +return 255; | |
66 | +} | |
67 | + | |
68 | +long millis(void){ | |
69 | +struct timeval tv; | |
70 | +gettimeofday(&tv,NULL); | |
71 | +return tv.tv_sec*1000+tv.tv_usec/1000; | |
72 | +} | |
73 | + | |
74 | +//// | |
75 | +// Events function | |
76 | +//// | |
77 | + | |
78 | +static void handleEvents(int sd){ | |
79 | +struct pollfd fds[2]; | |
80 | +char line[MAX_LINE]; | |
81 | +unsigned char packet[MAX_SERIAL]; | |
82 | +int ret; | |
83 | +// my variables | |
84 | + | |
85 | +// | |
86 | +fds[0].fd=STDIN_FILENO; | |
87 | +fds[0].events=POLLIN; | |
88 | +fds[1].fd=sd; | |
89 | +fds[1].events=POLLIN; | |
90 | + | |
91 | +while(1){ | |
92 | + loop(); | |
93 | + ret=poll(fds,2,SLEEP_DELAY); | |
94 | + if(ret==-1){ perror("poll"); exit(EXIT_FAILURE); } | |
95 | + if(fds[0].revents&POLLIN){ | |
96 | + if(fgets(line,MAX_LINE,stdin)==NULL){ perror("fgets"); exit(EXIT_FAILURE); } | |
97 | +#ifdef DEBUG | |
98 | + printf("keyboard: %s",line); | |
99 | +#endif | |
100 | + int i; | |
101 | + for(i=0;i<strlen(line);i++){ | |
102 | + if(line[i]>='a' && line[i]<='d') _button(line[i]-'a',0); | |
103 | + if(line[i]>='A' && line[i]<='D') _button(line[i]-'A',1); | |
104 | + } | |
105 | + } | |
106 | + if(fds[1].revents&POLLIN){ | |
107 | + int nb; | |
108 | + if((nb=read(sd,packet,MAX_SERIAL))<=0) break; | |
109 | +#ifdef DEBUG | |
110 | + printf("serial in: "); | |
111 | +#endif | |
112 | + int i; | |
113 | + for(i=0;i<nb;i++){ | |
114 | +#ifdef DEBUG | |
115 | + printf("%02x ",packet[i]); | |
116 | +#endif | |
117 | + serialInHandler(packet[i]); | |
118 | + } | |
119 | +#ifdef DEBUG | |
120 | + printf("\n"); | |
121 | +#endif | |
122 | + } | |
123 | + if(outsize>0){ | |
124 | + if(write(sd,outbuf,outsize)!=outsize) break; | |
125 | +#ifdef DEBUG | |
126 | + printf("serial out: "); | |
127 | + int i; | |
128 | + for(i=0;i<outsize;i++){ | |
129 | + printf("%02x ",outbuf[i]); | |
130 | + } | |
131 | + printf("\n"); | |
132 | +#endif | |
133 | + outsize=0; | |
134 | + } | |
135 | + } | |
136 | +} | |
137 | + | |
138 | +//// | |
139 | +// Main function | |
140 | +//// | |
141 | + | |
142 | +int main(void){ | |
143 | +char name[MAX_NAME]; | |
144 | +int sd=virtualSerialOpen(name,SERIAL_SPEED); | |
145 | +printf("Slave device is '%s'\n",name); | |
146 | +setup(); | |
147 | +handleEvents(sd); | |
148 | +virtualSerialClose(sd); | |
149 | +exit(0); | |
150 | +} | ... | ... |
... | ... | @@ -0,0 +1,26 @@ |
1 | +/* | |
2 | + * Constants and prototype for Arduino simulator | |
3 | + */ | |
4 | + | |
5 | +//// | |
6 | +// Constants | |
7 | +//// | |
8 | +#define BUTTONS_NB 4 | |
9 | +#define LEDS_NB 6 | |
10 | + | |
11 | +//// | |
12 | +// Prototypes of defined fonctions | |
13 | +//// | |
14 | + | |
15 | +void led(int num,unsigned char state); | |
16 | +unsigned char button(int num); | |
17 | +void serialSend(unsigned char *data,int size); | |
18 | +long millis(void); | |
19 | + | |
20 | +//// | |
21 | +// Prototypes of users handlers | |
22 | +//// | |
23 | + | |
24 | +void setup(void); | |
25 | +void loop(void); | |
26 | +void serialInHandler(unsigned char byte); | ... | ... |
No preview for this file type
... | ... | @@ -0,0 +1,37 @@ |
1 | +/* | |
2 | + * Arduino program example | |
3 | + */ | |
4 | + | |
5 | +//// | |
6 | +// Include files | |
7 | +//// | |
8 | +#include "arduino.h" | |
9 | +#include <stdio.h> | |
10 | +//// | |
11 | +// Global variables | |
12 | +// my variables | |
13 | +int i; | |
14 | +long now; | |
15 | +// | |
16 | +//// | |
17 | + | |
18 | +//// | |
19 | +// Handler functions | |
20 | +/// | |
21 | + | |
22 | +void setup(void){ | |
23 | + i = 0; | |
24 | +} | |
25 | + | |
26 | +void loop(void){ | |
27 | + led((i-1 + LEDS_NB) % LEDS_NB, 0); | |
28 | + led(i % LEDS_NB, 1); | |
29 | + now = millis(); | |
30 | + while(millis() != now+100); | |
31 | + i = (i+1) % LEDS_NB; | |
32 | + | |
33 | +} | |
34 | + | |
35 | + | |
36 | +void serialInHandler(unsigned char byte){ | |
37 | +} | ... | ... |
No preview for this file type
... | ... | @@ -0,0 +1,69 @@ |
1 | +/* | |
2 | + * Virtual Serial library | |
3 | + */ | |
4 | + | |
5 | +//// | |
6 | +// Include files | |
7 | +//// | |
8 | +#include <stdio.h> | |
9 | +#include <stdlib.h> | |
10 | +#include <unistd.h> | |
11 | +#include <termios.h> | |
12 | +#include <strings.h> | |
13 | +#include <sys/types.h> | |
14 | +#include <sys/ioctl.h> | |
15 | +#include <sys/file.h> | |
16 | +#include <linux/serial.h> | |
17 | +#include <pty.h> | |
18 | + | |
19 | +#include "virtual_serial.h" | |
20 | + | |
21 | +//// | |
22 | +// Functions | |
23 | +//// | |
24 | + | |
25 | +// | |
26 | +// Serial structure filling | |
27 | +// | |
28 | +static struct termios serialConfig(int speed){ | |
29 | +int fspeed; | |
30 | +switch(speed){ | |
31 | + case 1200: fspeed=B1200; break; | |
32 | + case 2400: fspeed=B2400; break; | |
33 | + case 4800: fspeed=B4800; break; | |
34 | + case 9600: fspeed=B9600; break; | |
35 | + case 19200: fspeed=B19200; break; | |
36 | + case 38400: fspeed=B38400; break; | |
37 | + case 57600: fspeed=B57600; break; | |
38 | + case 115200: fspeed=B115200; break; | |
39 | + default: fprintf(stderr,"Unknown serial speed %d.\n",speed); exit(-1); | |
40 | + } | |
41 | +struct termios new; | |
42 | +bzero(&new,sizeof(new)); | |
43 | +new.c_cflag=CLOCAL|CREAD|fspeed|CS8; | |
44 | +new.c_iflag=0; | |
45 | +new.c_oflag=0; | |
46 | +new.c_lflag=0; /* set input mode (non-canonical, no echo,...) */ | |
47 | +new.c_cc[VTIME]=0; /* inter-character timer unused */ | |
48 | +new.c_cc[VMIN]=1; /* blocking read until 1 char received */ | |
49 | +return new; | |
50 | +} | |
51 | + | |
52 | +// | |
53 | +// Virtual serial creation | |
54 | +// | |
55 | + | |
56 | +int virtualSerialOpen(char *name,int speed){ | |
57 | +int master; | |
58 | +int slave; | |
59 | +struct termios serial=serialConfig(speed); | |
60 | +openpty(&master,&slave,name,&serial,NULL); | |
61 | +return master; | |
62 | +} | |
63 | + | |
64 | +// | |
65 | +// Serial port termination | |
66 | +// | |
67 | +void virtualSerialClose(int fd){ | |
68 | +close(fd); | |
69 | +} | ... | ... |
No preview for this file type