qi-hardware/antorcha
1
0
Fork 0
mirror of git://projects.qi-hardware.com/antorcha.git synced 2024-11-22 08:45:55 +02:00
Code

fw/image.c (localize_line): export line format conversion function

Browse Source
This commit is contained in:
Werner Almesberger 2012-07-01 10:20:33 -03:00
parent 6fac517d48
commit 69d9013a0d
2 changed files with 17 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
fw/image.c
View File

@ -42,18 +42,23 @@ const struct line *image = images[0];
((value) & 128 ? MASK(port, LED_##group##8) : 0))
struct line localize_line(uint8_t p0, uint8_t p1)
{
struct line res;
res.cb = MAP(B, p0, A) | MAP(B, p1, B) |
MAP(C, p0, A) | MAP(C, p1, B);
res.d = MAP(D, p0, A) | MAP(D, p1, B);
return res;
}
static void add_payload(const uint8_t *payload)
{
uint8_t i, b, c, d;
uint8_t i;
for (i = 0; i != PAYLOAD && p != end; i += 2) {
b = MAP(B, payload[i], A) | MAP(B, payload[i+1], B);
c = MAP(C, payload[i], A) | MAP(C, payload[i+1], B);
d = MAP(D, payload[i], A) | MAP(D, payload[i+1], B);
p->d = d;
p->cb = c | b;
p++;
}
for (i = 0; i != PAYLOAD && p != end; i += 2)
*p++ = localize_line(payload[i], payload[i+1]);
}

3
fw/image.h
View File

@ -25,4 +25,7 @@ struct line {
extern const struct line *image;
struct line localize_line(uint8_t p0, uint8_t p1);
#endif /* !IMAGE_H */