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
|
#include "bringup.h"
#include "board.h"
#include "log.h"
#include <Wire.h>
#include <SPI.h>
using namespace ocularium;
void bringup::startup_checks(const etl::span<bringup::init_check> &checks)
{
auto success = true;
auto fault_indication = false;
do
{
success = true;
for (auto &[name, f, succeeded] : checks)
{
if (succeeded)
continue;
LOGGER.print("checking " + name + "... ");
succeeded = f();
success = success && succeeded;
if (succeeded) LOGGER.println("ok");
else LOGGER.println("bad");
}
if (!success)
{
fault_indication = !fault_indication;
digitalWrite(LED_FAULT, fault_indication);
delay(25);
}
} while (!success);
digitalWrite(LED_FAULT, LOW);
}
void bringup::init_buses()
{
Wire1.setSCL(SCL_PIN);
Wire1.setSDA(SDA_PIN);
Wire1.setClock(100000);
Wire1.begin();
SD_SPI.setCS(SD_CS);
SD_SPI.setMOSI(SD_MOSI);
SD_SPI.setMISO(SD_MISO);
SD_SPI.setSCK(SD_SCK);
SD_SPI.begin();
LSM_SPI.setCS(LSM_CS);
LSM_SPI.setMOSI(LSM_MOSI);
LSM_SPI.setMISO(LSM_MISO);
LSM_SPI.setSCK(LSM_SCK);
LSM_SPI.begin();
}
void bringup::init_pins()
{
pinMode(CARD_DETECT, INPUT);
pinMode(LED_FAULT, OUTPUT);
pinMode(LED_CAPTURING, OUTPUT);
pinMode(LED_OTHER, OUTPUT);
pinMode(LED_STORAGE, OUTPUT);
pinMode(LSM_INT1, INPUT);
pinMode(LSM_INT2, INPUT);
}
void bringup::boot_animation()
{
constexpr pin_size_t chase[] = {
LED_STORAGE,
LED_OTHER,
LED_FAULT,
LED_CAPTURING,
};
for (auto i = 0; i < 4; i++)
{
for (const auto pin: chase)
{
digitalWrite(pin, HIGH);
delay(75);
digitalWrite(pin, LOW);
}
}
delay(100);
for (auto i = 0; i < 2; i++)
{
for (const auto pin : chase)
{
digitalWrite(pin, HIGH);
}
delay(100);
for (const auto pin : chase)
{
digitalWrite(pin, LOW);
}
delay(100);
}
}
|
