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
|
#include "trackhat.hpp"
#include "compat/sleep.hpp"
namespace trackhat_impl {
trackhat_settings::trackhat_settings() : opts{"tracker-trackhat"}
{
}
void setting_receiver::settings_changed()
{
changed = true;
}
bool setting_receiver::test_and_clear()
{
bool x = true;
return changed.compare_exchange_strong(x, false);
}
} // ns trackhat_impl
void trackhat_camera::set_pt_options()
{
s.min_point_size = t.min_pt_size;
s.max_point_size = t.max_pt_size;
switch (t.model)
{
default:
case model_cap:
s.t_MH_x = 0; s.t_MH_y = 0; s.t_MH_z = 0;
break;
case model_mystery_meat:
case model_clip_left:
case model_mini_clip_left:
s.t_MH_x = -135; s.t_MH_y = 0; s.t_MH_z = 0;
break;
case model_clip_right:
case model_mini_clip_right:
s.t_MH_x = 135; s.t_MH_y = 0; s.t_MH_z = 0;
break;
}
switch (t.model)
{
default:
eval_once(qDebug() << "tracker/trackhat: unknown model");
[[fallthrough]];
case model_clip_left:
case model_clip_right:
s.clip_tz = 27; s.clip_ty = 43; s.clip_by = 62; s.clip_bz = 74;
break;
case model_mini_clip_left:
case model_mini_clip_right:
s.clip_tz = 13; s.clip_ty = 42; s.clip_by = 60; s.clip_bz = 38;
break;
case model_cap:
s.cap_x = 60; s.cap_y = 90; s.cap_z = 95;
break;
case model_mystery_meat:
s.clip_tz = 15; s.clip_ty = 40; s.clip_by = 70; s.clip_bz = 40;
break;
}
s.camera_name = "TrackHat Sensor (WIP)";
s.active_model_panel = t.model == model_cap ? 1 : 0;
s.enable_point_filter = t.enable_point_filter;
s.point_filter_coefficient = *t.point_filter_coefficient;
}
int trackhat_camera::init_regs()
{
unsigned attempts = 0;
constexpr unsigned max_attempts = 5;
TH_ErrorCode error;
auto exp = (uint8_t)t.exposure;
auto thres = (uint8_t)t.threshold;
auto thres2 = (uint8_t)std::clamp((int)*t.threshold_2, 0, std::max(64, thres-1));
auto gain = (uint8_t)*t.gain;
auto gain_c = (uint8_t)((gain/0x0f + !!(gain/0x0f)) & 3);
gain %= 0x0f;
const uint8_t regs[][3] = {
{ 0x0c, 0x0f, 0xf0 }, // exposure lo
{ 0x0c, 0x10, exp }, // exposure hi
{ 0x00, 0x0b, 0xff }, // blob area max size
{ 0x00, 0x0c, 0x03 }, // blob area min size
{ 0x0c, 0x08, gain }, // gain
{ 0x0c, 0x0c, gain_c }, // gain multiplier
{ 0x0c, 0x47, thres }, // min brightness
{ 0x00, 0x0f, thres2 }, // brightness margin, formula is `thres >= px > thres - fuzz'
{ 0x00, 0x01, 0x01 }, // bank0 sync
{ 0x01, 0x01, 0x01 }, // bank1 sync
};
start:
for (const auto& reg : regs)
{
trackHat_SetRegister_t r{reg[0], reg[1], reg[2]};
error = trackHat_SetRegisterValue(&device, &r);
if (error != TH_SUCCESS)
goto error;
}
return TH_SUCCESS;
error:
if (attempts++ < max_attempts)
{
portable::sleep(10);
goto start;
}
return error;
}
|
