blob: 2237b4d12535faa68d556c76b7c0aff8476738eb (
plain)
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
|
#include <FreeRTOS.h>
#include <task.h>
#include <stdio.h>
#include <stddef.h>
#include <stdint.h>
#include <pico/stdlib.h>
#include <hardware/i2c.h>
#include "i2c.h"
#include "pb-mod.h"
#include "config.h"
#include "pb-buf.h"
#include "pb-send.h"
// stolen from lib/pico-sdk/src/rp2_common/hardware_i2c/i2c.c
#define i2c_reserved_addr(addr) (((addr) & 0x78) == 0 || ((addr) & 0x78) == 0x78)
i2c_addr_t modules[CFG_PB_MOD_MAX];
size_t modules_size = 0;
static void bus_scan() {
pb_buf_t buf = pb_send_magic_req();
// check for all 7-bit addresses
uint16_t addr_max = 1 << 7;
for (uint16_t addr = 0x00; addr < addr_max; addr++) {
if (i2c_reserved_addr(addr)) continue;
if (addr == PB_MOD_ADDR) continue;
pb_i2c_send(addr, (uint8_t *) buf.data, buf.size);
}
pb_buf_free(&buf);
}
static void state_exchange() {
for (size_t i = 0; i < modules_size; i++) {
pb_buf_t buf = pb_send_state_req();
pb_buf_free(&buf);
}
}
void bus_task() {
// do a scan of the bus
bus_scan();
while(1) {
// send my state to all puzzle modules
state_exchange();
// wait 1 second
vTaskDelay(1e3 / portTICK_PERIOD_MS);
}
}
/**
* \ingroup main_pb_override
* \anchor main_route_cmd_magic_res
*
* This function registers the I2C address of the puzzle module that replied to
* the \c MAGIC \c REQ command into a list of "known puzzle modules", which are
* then periodically updated during gameplay.
*
* \note Up to \ref CFG_PB_MOD_MAX puzzle modules can be registered
* simultaniously.
*/
void pb_route_cmd_magic_res(pb_msg_t * msg) {
if (modules_size == CFG_PB_MOD_MAX) return;
modules[modules_size++] = msg->sender;
printf("i2c: registered puzzle module w/ address 0x%02x\n", msg->sender);
}
|