1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
|
/**
* Lets imagine that we have board with LIS3LV02DL accelerometer on channel #1
* and MAX1236 ADC, TMP75 thermometer on channel #2.
*
* NOTE: I assume, that you have datasheets on all this stuff.
*
* NOTE: Also, I assume, that you know how to I2C works.
*
* In order from simplicity to complexity:
* TMP75
* MAX1236
* LIS3LV02DL
*
* Project splitted to separate source files for each device.
*
* Data from sensors we will be read from different thread sleeping different
* amount of time.
*/
#include <stdlib.h>
#include "ch.h"
#include "hal.h"
#include "i2c_pns.h"
#include "tmp75.h"
#include "max1236.h"
#include "lis3.h"
/*
* Red LEDs blinker thread, times are in milliseconds.
*/
static WORKING_AREA(BlinkWA, 128);
static msg_t Blink(void *arg) {
(void)arg;
while (TRUE) {
palClearPad(IOPORT3, GPIOC_LED);
chThdSleepMilliseconds(500);
palSetPad(IOPORT3, GPIOC_LED);
chThdSleepMilliseconds(500);
}
return 0;
}
/* Temperature polling thread */
static WORKING_AREA(PollTmp75ThreadWA, 128);
static msg_t PollTmp75Thread(void *arg) {
(void)arg;
systime_t time = chTimeNow();
while (TRUE) {
time += MS2ST(1001);
/* Call reading function */
request_temperature();
chThdSleepUntil(time);
}
return 0;
}
/* MAX1236 polling thread */
static WORKING_AREA(PollMax1236ThreadWA, 128);
static msg_t PollMax1236Thread(void *arg) {
(void)arg;
systime_t time = chTimeNow();
while (TRUE) {
time += MS2ST(200);
/* Call reading function */
read_max1236();
chThdSleepUntil(time);
}
return 0;
}
static WORKING_AREA(PollAccelThreadWA, 128);
static msg_t PollAccelThread(void *arg) {
(void)arg;
systime_t time = chTimeNow();
while (TRUE) {
time += MS2ST(20);
request_acceleration_data();
chThdSleepUntil(time);
}
return 0;
}
/*
* Entry point, note, the main() function is already a thread in the system
* on entry.
*/
int main(void) {
halInit();
chSysInit();
I2CInit_pns();
/* Create temperature thread */
chThdCreateStatic(PollTmp75ThreadWA,
sizeof(PollTmp75ThreadWA),
NORMALPRIO,
PollTmp75Thread,
NULL);
/* Create max1236 thread */
chThdCreateStatic(PollMax1236ThreadWA,
sizeof(PollMax1236ThreadWA),
NORMALPRIO,
PollMax1236Thread,
NULL);
/* Create accelerometer thread */
chThdCreateStatic(PollAccelThreadWA,
sizeof(PollAccelThreadWA),
HIGHPRIO,
PollAccelThread,
NULL);
/* Creates the blinker thread. */
chThdCreateStatic(BlinkWA, sizeof(BlinkWA), LOWPRIO, Blink, NULL);
/* main loop that do nothing */
while (TRUE) {
chThdSleepMilliseconds(500);
}
return 0;
}
|
