forked from IntelRealSense/librealsense
-
Notifications
You must be signed in to change notification settings - Fork 0
/
ds5-private.h
674 lines (590 loc) · 27.6 KB
/
ds5-private.h
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
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
// License: Apache 2.0. See LICENSE file in root directory.
// Copyright(c) 2015 Intel Corporation. All Rights Reserved.
#pragma once
#include "backend.h"
#include "types.h"
#include <map>
#include <iomanip>
#include <string>
namespace librealsense
{
namespace ds
{
const uint16_t RS400_PID = 0x0ad1; // PSR
const uint16_t RS410_PID = 0x0ad2; // ASR
const uint16_t RS415_PID = 0x0ad3; // ASRC
const uint16_t RS430_PID = 0x0ad4; // AWG
const uint16_t RS430_MM_PID = 0x0ad5; // AWGT
const uint16_t RS_USB2_PID = 0x0ad6; // USB2
const uint16_t RS400_IMU_PID = 0x0af2; // IMU
const uint16_t RS420_PID = 0x0af6; // PWG
const uint16_t RS420_MM_PID = 0x0afe; // PWGT
const uint16_t RS410_MM_PID = 0x0aff; // ASRT
const uint16_t RS400_MM_PID = 0x0b00; // PSR
const uint16_t RS430_MM_RGB_PID = 0x0b01; // AWGCT
const uint16_t RS460_PID = 0x0b03; // DS5U
const uint16_t RS435_RGB_PID = 0x0b07; // AWGC
const uint16_t RS405_PID = 0x0b0c; // DS5U
const uint16_t RS435I_PID = 0x0b3a; // D435i
// DS5 depth XU identifiers
const uint8_t DS5_HWMONITOR = 1;
const uint8_t DS5_DEPTH_EMITTER_ENABLED = 2;
const uint8_t DS5_EXPOSURE = 3;
const uint8_t DS5_LASER_POWER = 4;
const uint8_t DS5_ERROR_REPORTING = 7;
const uint8_t DS5_EXT_TRIGGER = 8;
const uint8_t DS5_ASIC_AND_PROJECTOR_TEMPERATURES = 9;
const uint8_t DS5_ENABLE_AUTO_WHITE_BALANCE = 0xA;
const uint8_t DS5_ENABLE_AUTO_EXPOSURE = 0xB;
// Devices supported by the current version
static const std::set<std::uint16_t> rs400_sku_pid = {
ds::RS400_PID,
ds::RS410_PID,
ds::RS415_PID,
ds::RS430_PID,
ds::RS430_MM_PID,
ds::RS_USB2_PID,
ds::RS400_IMU_PID,
ds::RS420_PID,
ds::RS420_MM_PID,
ds::RS410_MM_PID,
ds::RS400_MM_PID,
ds::RS430_MM_RGB_PID,
ds::RS460_PID,
ds::RS435_RGB_PID,
ds::RS405_PID,
ds::RS435I_PID,
};
static const std::set<std::uint16_t> multi_sensors_pid = {
ds::RS400_MM_PID,
ds::RS410_MM_PID,
ds::RS415_PID,
ds::RS420_MM_PID,
ds::RS430_MM_PID,
ds::RS430_MM_RGB_PID,
ds::RS435_RGB_PID,
ds::RS435I_PID
};
static const std::set<std::uint16_t> hid_sensors_pid = {
ds::RS435I_PID
};
static const std::set<std::uint16_t> fisheye_pid = {
ds::RS400_MM_PID,
ds::RS410_MM_PID,
ds::RS420_MM_PID,
ds::RS430_MM_PID,
ds::RS430_MM_RGB_PID,
};
static const std::map<std::uint16_t, std::string> rs400_sku_names = {
{ RS400_PID, "Intel RealSense D400"},
{ RS400_MM_PID, "Intel RealSense D400 with Tracking Module"},
{ RS410_PID, "Intel RealSense D410"},
{ RS410_MM_PID, "Intel RealSense D410 with Tracking Module"},
{ RS415_PID, "Intel RealSense D415"},
{ RS420_PID, "Intel RealSense D420"},
{ RS420_MM_PID, "Intel RealSense D420 with Tracking Module"},
{ RS430_PID, "Intel RealSense D430"},
{ RS430_MM_PID, "Intel RealSense D430 with Tracking Module"},
{ RS430_MM_RGB_PID, "Intel RealSense D430 with Tracking and RGB Modules"},
{ RS435_RGB_PID, "Intel RealSense D435"},
{ RS460_PID, "Intel RealSense D460" },
{ RS405_PID, "Intel RealSense D405" },
{ RS435I_PID, "Intel RealSense D435I" },
{ RS_USB2_PID, "Intel RealSense USB2" },
{ RS400_IMU_PID, "Intel RealSense IMU" }
};
// DS5 fisheye XU identifiers
const uint8_t FISHEYE_EXPOSURE = 1;
// subdevice[h] unit[fw], node[h] guid[fw]
const platform::extension_unit depth_xu = { 0, 3, 2,
{ 0xC9606CCB, 0x594C, 0x4D25,{ 0xaf, 0x47, 0xcc, 0xc4, 0x96, 0x43, 0x59, 0x95 } } };
const platform::extension_unit fisheye_xu = { 3, 12, 2,
{ 0xf6c3c3d1, 0x5cde, 0x4477,{ 0xad, 0xf0, 0x41, 0x33, 0xf5, 0x8d, 0xa6, 0xf4 } } };
enum fw_cmd : uint8_t
{
GLD = 0x0f, // FW logs
GVD = 0x10, // camera details
GETINTCAL = 0x15, // Read calibration table
HWRST = 0x20, // hardware reset
OBW = 0x29, // OVT bypass write
SET_ADV = 0x2B, // set advanced mode control
GET_ADV = 0x2C, // get advanced mode control
EN_ADV = 0x2D, // enable advanced mode
UAMG = 0X30, // get advanced mode status
SETAEROI = 0x44, // set auto-exposure region of interest
GETAEROI = 0x45, // get auto-exposure region of interest
MMER = 0x4F, // MM EEPROM read ( from DS5 cache )
GET_EXTRINSICS = 0x53, // get extrinsics
SET_CAM_SYNC = 0x69, // set Inter-cam HW sync mode [0-default, 1-master, 2-slave]
GET_CAM_SYNC = 0x6A, // fet Inter-cam HW sync mode
SETRGBAEROI = 0x75, // set RGB auto-exposure region of interest
GETRGBAEROI = 0x76, // get RGB auto-exposure region of interest
SET_PWM_ON_OFF = 0x77, // set emitter on and off mode
GET_PWM_ON_OFF = 0x78, // get emitter on and off mode
SETSUBPRESET = 0x7B, // Download sub-preset
GETSUBPRESET = 0x7C, // Upload the current sub-preset
GETSUBPRESETNAME= 0x7D, // Retrieve sub-preset's name
};
#define TOSTRING(arg) #arg
#define VAR_ARG_STR(x) TOSTRING(x)
#define ENUM2STR(x) case(x):return VAR_ARG_STR(x);
inline std::string fw_cmd2str(const fw_cmd state)
{
switch(state)
{
ENUM2STR(GLD);
ENUM2STR(GVD);
ENUM2STR(GETINTCAL);
ENUM2STR(OBW);
ENUM2STR(SET_ADV);
ENUM2STR(GET_ADV);
ENUM2STR(EN_ADV);
ENUM2STR(UAMG);
ENUM2STR(SETAEROI);
ENUM2STR(GETAEROI);
ENUM2STR(MMER);
ENUM2STR(GET_EXTRINSICS);
ENUM2STR(SET_CAM_SYNC);
ENUM2STR(GET_CAM_SYNC);
ENUM2STR(SETRGBAEROI);
ENUM2STR(GETRGBAEROI);
ENUM2STR(SET_PWM_ON_OFF);
ENUM2STR(GET_PWM_ON_OFF);
ENUM2STR(SETSUBPRESET);
ENUM2STR(GETSUBPRESET);
ENUM2STR(GETSUBPRESETNAME);
default:
return (to_string() << "Unrecognized FW command " << state);
}
}
const int etDepthTableControl = 9; // Identifier of the depth table control
enum advanced_query_mode
{
GET_VAL = 0,
GET_MIN = 1,
GET_MAX = 2,
};
enum inter_cam_sync_mode
{
INTERCAM_SYNC_DEFAULT,
INTERCAM_SYNC_MASTER,
INTERCAM_SYNC_SLAVE,
INTERCAM_SYNC_MAX
};
enum class d400_caps : uint16_t
{
CAP_UNDEFINED = 0,
CAP_ACTIVE_PROJECTOR = (1u << 0), //
CAP_RGB_SENSOR = (1u << 1), // Dedicated RGB sensor
CAP_FISHEYE_SENSOR = (1u << 2), // TM1
CAP_IMU_SENSOR = (1u << 3),
CAP_GLOBAL_SHUTTER = (1u << 4),
CAP_ROLLING_SHUTTER = (1u << 5),
CAP_MAX
};
static const std::map<d400_caps, std::string> d400_capabilities_names = {
{ d400_caps::CAP_UNDEFINED, "Undefined" },
{ d400_caps::CAP_ACTIVE_PROJECTOR, "Active Projector" },
{ d400_caps::CAP_RGB_SENSOR, "RGB Sensor" },
{ d400_caps::CAP_FISHEYE_SENSOR, "Fisheye Sensor" },
{ d400_caps::CAP_IMU_SENSOR, "IMU Sensor" },
{ d400_caps::CAP_GLOBAL_SHUTTER, "Global Shutter" },
{ d400_caps::CAP_ROLLING_SHUTTER, "Rolling Shutter" }
};
inline d400_caps operator &(const d400_caps lhs, const d400_caps rhs)
{
return static_cast<d400_caps>(static_cast<uint32_t>(lhs) & static_cast<uint32_t>(rhs));
}
inline d400_caps operator |(const d400_caps lhs, const d400_caps rhs)
{
return static_cast<d400_caps>(static_cast<uint32_t>(lhs) | static_cast<uint32_t>(rhs));
}
inline d400_caps& operator |=(d400_caps& lhs, d400_caps rhs)
{
return lhs = lhs | rhs;
}
inline std::ostream& operator <<(std::ostream& stream, const d400_caps& cap)
{
for (auto i : { d400_caps::CAP_ACTIVE_PROJECTOR,d400_caps::CAP_RGB_SENSOR,
d400_caps::CAP_FISHEYE_SENSOR, d400_caps::CAP_IMU_SENSOR,
d400_caps::CAP_GLOBAL_SHUTTER, d400_caps::CAP_ROLLING_SHUTTER })
{
if (i==(i&cap))
stream << d400_capabilities_names.at(i) << " ";
}
return stream;
}
const std::string DEPTH_STEREO = "Stereo Module";
struct table_header
{
big_endian<uint16_t> version; // major.minor. Big-endian
uint16_t table_type; // ctCalibration
uint32_t table_size; // full size including: TOC header + TOC + actual tables
uint32_t param; // This field content is defined ny table type
uint32_t crc32; // crc of all the actual table data excluding header/CRC
};
enum ds5_rect_resolutions : unsigned short
{
res_1920_1080,
res_1280_720,
res_640_480,
res_848_480,
res_640_360,
res_424_240,
res_320_240,
res_480_270,
res_1280_800,
res_960_540,
reserved_1,
reserved_2,
res_640_400,
// Resolutions for DS5U
res_576_576,
res_720_720,
res_1152_1152,
max_ds5_rect_resolutions
};
struct coefficients_table
{
table_header header;
float3x3 intrinsic_left; // left camera intrinsic data, normilized
float3x3 intrinsic_right; // right camera intrinsic data, normilized
float3x3 world2left_rot; // the inverse rotation of the left camera
float3x3 world2right_rot; // the inverse rotation of the right camera
float baseline; // the baseline between the cameras in mm units
uint32_t brown_model; // Distortion model: 0 - DS distorion model, 1 - Brown model
uint8_t reserved1[88];
float4 rect_params[max_ds5_rect_resolutions];
uint8_t reserved2[64];
};
template<class T>
const T* check_calib(const std::vector<uint8_t>& raw_data)
{
using namespace std;
auto table = reinterpret_cast<const T*>(raw_data.data());
auto header = reinterpret_cast<const table_header*>(raw_data.data());
if(raw_data.size() < sizeof(table_header))
{
throw invalid_value_exception(to_string() << "Calibration data invald, buffer too small : expected " << sizeof(table_header) << " , actual: " << raw_data.size());
}
// verify the parsed table
if (table->header.crc32 != calc_crc32(raw_data.data() + sizeof(table_header), raw_data.size() - sizeof(table_header)))
{
throw invalid_value_exception("Calibration data CRC error, parsing aborted!");
}
LOG_DEBUG("Loaded Valid Table: version [mjr.mnr]: 0x" <<
hex << setfill('0') << setw(4) << header->version << dec
<< ", type " << header->table_type << ", size " << header->table_size
<< ", CRC: " << hex << header->crc32);
return table;
}
#pragma pack(push, 1)
struct fisheye_extrinsics_table
{
table_header header;
int64_t serial_mm;
int64_t serial_depth;
float3x3 rotation; // the fisheye rotation matrix
float3 translation; // the fisheye translation vector
};
struct extrinsics_table
{
float3x3 rotation;
float3 translation;
};
struct imu_intrinsics
{
float bias[3];
float scale[3];
};
// Note that the intrinsic definition follows rs2_motion_device_intrinsic with different data layout
struct imu_intrinsic
{
float3x3 sensitivity;
float3 bias;
float3 noise_variances; /**< Variance of noise for X, Y, and Z axis */
float3 bias_variances; /**< Variance of bias for X, Y, and Z axis */
};
struct fisheye_calibration_table
{
table_header header;
float intrinsics_model; // 1 - Brown, 2 - FOV, 3 - Kannala Brandt
float3x3 intrinsic; // FishEye intrinsic matrix, normalize by [-1 1]
float distortion[5]; // FishEye forward distortion parameters, F-theta model
extrinsics_table fisheye_to_imu; // FishEye rotation matrix and translation vector in IMU CS
uint8_t reserved[28];
};
constexpr size_t fisheye_calibration_table_size = sizeof(fisheye_calibration_table);
struct imu_calibration_table
{
table_header header;
float rmax;
extrinsics_table imu_to_imu;
imu_intrinsics accel_intrinsics;
imu_intrinsics gyro_intrinsics;
uint8_t reserved[64];
};
constexpr size_t imu_calibration_table_size = sizeof(imu_calibration_table);
struct tm1_module_info
{
table_header header;
uint8_t serial_num[8]; // 2 bytes reserved + 6 data (0000xxxxxxxxxxxx)
uint8_t optic_module_mm[4];
uint8_t ta[10];
uint32_t board_num; // SKU id
uint32_t board_rev; // 0
uint8_t reserved[34]; // Align to 64 byte ???
};
constexpr size_t tm1_module_info_size = sizeof(tm1_module_info);
struct tm1_calib_model
{
table_header header;
float calibration_model_flag; // 1 - Brown, 2 - FOV, 3 - Kannala Brandt ???????
fisheye_calibration_table fe_calibration;
float temperature;
uint8_t reserved[20];
};
constexpr size_t tm1_calib_model_size = sizeof(tm1_calib_model);
struct tm1_serial_num_table
{
table_header header;
uint8_t serial_num[8]; // 2 bytes reserved + 6 data 12 digits in (0000xxxxxxxxxxxx) format
uint8_t reserved[8];
};
constexpr size_t tm1_serial_num_table_size = sizeof(tm1_serial_num_table);
struct tm1_calibration_table
{
table_header header;
tm1_calib_model calib_model;
imu_calibration_table imu_calib_table;
tm1_serial_num_table serial_num_table;
};
constexpr size_t tm1_calibration_table_size = sizeof(tm1_calibration_table);
// TM1 ver 0.51
struct tm1_eeprom
{
table_header header;
tm1_module_info module_info;
tm1_calibration_table calibration_table;
};
constexpr size_t tm1_eeprom_size = sizeof(tm1_eeprom);
struct dm_v2_imu_intrinsic
{
float3x3 sensitivity;
float3 bias;
};
struct dm_v2_calibration_table
{
table_header header;
uint8_t extrinsic_valid;
uint8_t intrinsic_valid;
uint8_t reserved[2];
extrinsics_table depth_to_imu; // The extrinsic parameters of IMU persented in Depth sensor's CS
dm_v2_imu_intrinsic accel_intrinsic;
dm_v2_imu_intrinsic gyro_intrinsic;
uint8_t reserved1[96];
};
constexpr size_t dm_v2_calibration_table_size = sizeof(dm_v2_calibration_table);
struct dm_v2_calib_info
{
table_header header;
dm_v2_calibration_table dm_v2_calib_table;
tm1_serial_num_table serial_num_table;
};
constexpr size_t dm_v2_calib_info_size = sizeof(dm_v2_calib_info);
// Depth Module V2 IMU EEPROM ver 0.52
struct dm_v2_eeprom
{
table_header header;
dm_v2_calib_info module_info;
};
constexpr size_t dm_v2_eeprom_size = sizeof(dm_v2_eeprom);
union eeprom_imu_table {
tm1_eeprom tm1_table;
dm_v2_eeprom dm_v2_table;
};
constexpr size_t eeprom_imu_table_size = sizeof(eeprom_imu_table);
enum imu_eeprom_id : uint16_t
{
dm_v2_eeprom_id = 0x0101, // The pack alignment is Big-endian
tm1_eeprom_id = 0x0002
};
struct depth_table_control
{
uint32_t depth_units;
int32_t depth_clamp_min;
int32_t depth_clamp_max;
int32_t disparity_multiplier;
int32_t disparity_shift;
};
struct rgb_calibration_table
{
table_header header;
// RGB Intrinsic
float3x3 intrinsic; // normalized by [-1 1]
float distortion[5]; // RGB forward distortion coefficients, Brown model
// RGB Extrinsic
float3 rotation; // RGB rotation angles (Rodrigues)
float3 translation; // RGB translation vector, mm
// RGB Projection
float projection[12]; // Projection matrix from depth to RGB [3 X 4]
uint16_t width; // original calibrated resolution
uint16_t height;
// RGB Rectification Coefficients
float3x3 intrinsic_matrix_rect; // RGB intrinsic matrix after rectification
float3x3 rotation_matrix_rect; // Rotation matrix for rectification of RGB
float3 translation_rect; // Translation vector for rectification
float reserved[24];
};
inline rs2_motion_device_intrinsic create_motion_intrinsics(imu_intrinsic data)
{
rs2_motion_device_intrinsic result{};
for (int i = 0; i < 3; i++)
{
for (int j = 0; j < 3; j++)
result.data[i][j] = data.sensitivity(i,j);
result.data[i][3] = data.bias[i];
result.bias_variances[i] = data.bias_variances[i];
result.noise_variances[i] = data.noise_variances[i];
}
return result;
}
#pragma pack(pop)
enum gvd_fields
{
// Keep sorted
camera_fw_version_offset = 12,
is_camera_locked_offset = 25,
module_serial_offset = 48,
fisheye_sensor_lb = 112,
fisheye_sensor_hb = 113,
depth_sensor_type = 166,
active_projector = 170,
rgb_sensor = 174,
imu_sensor = 178,
motion_module_fw_version_offset = 212
};
enum calibration_table_id
{
coefficients_table_id = 25,
depth_calibration_id = 31,
rgb_calibration_id = 32,
fisheye_calibration_id = 33,
imu_calibration_id = 34,
lens_shading_id = 35,
projector_id = 36,
max_id = -1
};
struct ds5_calibration
{
uint16_t version; // major.minor
rs2_intrinsics left_imager_intrinsic;
rs2_intrinsics right_imager_intrinsic;
rs2_intrinsics depth_intrinsic[max_ds5_rect_resolutions];
rs2_extrinsics left_imager_extrinsic;
rs2_extrinsics right_imager_extrinsic;
rs2_extrinsics depth_extrinsic;
std::map<calibration_table_id, bool> data_present;
ds5_calibration() : version(0), left_imager_intrinsic({}), right_imager_intrinsic({}),
left_imager_extrinsic({}), right_imager_extrinsic({}), depth_extrinsic({})
{
for (auto i = 0; i < max_ds5_rect_resolutions; i++)
depth_intrinsic[i] = {};
data_present.emplace(coefficients_table_id, false);
data_present.emplace(depth_calibration_id, false);
data_present.emplace(rgb_calibration_id, false);
data_present.emplace(fisheye_calibration_id, false);
data_present.emplace(imu_calibration_id, false);
data_present.emplace(lens_shading_id, false);
data_present.emplace(projector_id, false);
};
};
static std::map< ds5_rect_resolutions, int2> resolutions_list = {
{ res_320_240,{ 320, 240 } },
{ res_424_240,{ 424, 240 } },
{ res_480_270,{ 480, 270 } },
{ res_640_360,{ 640, 360 } },
{ res_640_400,{ 640, 400 } },
{ res_640_480,{ 640, 480 } },
{ res_848_480,{ 848, 480 } },
{ res_960_540,{ 960, 540 } },
{ res_1280_720,{ 1280, 720 } },
{ res_1280_800,{ 1280, 800 } },
{ res_1920_1080,{ 1920, 1080 } },
//Resolutions for DS5U
{ res_576_576,{ 576, 576 } },
{ res_720_720,{ 720, 720 } },
{ res_1152_1152,{ 1152, 1152 } },
};
ds5_rect_resolutions width_height_to_ds5_rect_resolutions(uint32_t width, uint32_t height);
rs2_intrinsics get_intrinsic_by_resolution(const std::vector<uint8_t>& raw_data, calibration_table_id table_id, uint32_t width, uint32_t height, uint32_t fps);
rs2_intrinsics get_intrinsic_by_resolution_coefficients_table(const std::vector<uint8_t>& raw_data, uint32_t width, uint32_t height, uint32_t fps);
rs2_intrinsics get_intrinsic_fisheye_table(const std::vector<uint8_t>& raw_data, uint32_t width, uint32_t height);
pose get_fisheye_extrinsics_data(const std::vector<uint8_t>& raw_data);
pose get_color_stream_extrinsic(const std::vector<uint8_t>& raw_data);
bool try_fetch_usb_device(std::vector<platform::usb_device_info>& devices,
const platform::uvc_device_info& info, platform::usb_device_info& result);
enum ds5_notifications_types
{
success = 0,
hot_laser_power_reduce,
hot_laser_disable,
flag_B_laser_disable,
stereo_module_not_connected,
eeprom_corrupted,
calibration_corrupted,
mm_upd_fail,
isp_upd_fail,
mm_force_pause,
mm_failure,
usb_scp_overflow,
usb_rec_overflow,
usb_cam_overflow,
mipi_left_error,
mipi_right_error,
mipi_rt_error,
mipi_fe_error,
i2c_cfg_left_error,
i2c_cfg_right_error,
i2c_cfg_rt_error,
i2c_cfg_fe_error,
stream_not_start_z,
stream_not_start_y,
stream_not_start_cam,
rec_error,
};
// Elaborate FW XU report. The reports may be consequently extended for PU/CTL/ISP
const std::map< uint8_t, std::string> ds5_fw_error_report = {
{ success, "Success" },
{ hot_laser_power_reduce, "Laser hot - power reduce" },
{ hot_laser_disable, "Laser hot - disabled" },
{ flag_B_laser_disable, "Flag B - laser disabled" },
{ stereo_module_not_connected, "Stereo Module is not connected" },
{ eeprom_corrupted, "EEPROM corrupted" },
{ calibration_corrupted, "Calibration corrupted" },
{ mm_upd_fail, "Motion Module update failed" },
{ isp_upd_fail, "ISP update failed" },
{ mm_force_pause, "Motion Module force pause" },
{ mm_failure, "Motion Module failure" },
{ usb_scp_overflow, "USB SCP overflow" },
{ usb_rec_overflow, "USB REC overflow" },
{ usb_cam_overflow, "USB CAM overflow" },
{ mipi_left_error, "Left MIPI error" },
{ mipi_right_error, "Right MIPI error" },
{ mipi_rt_error, "RT MIPI error" },
{ mipi_fe_error, "FishEye MIPI error" },
{ i2c_cfg_left_error, "Left IC2 Config error" },
{ i2c_cfg_right_error, "Right IC2 Config error" },
{ i2c_cfg_rt_error, "RT IC2 Config error" },
{ i2c_cfg_fe_error, "FishEye IC2 Config error" },
{ stream_not_start_z, "Depth stream start failure" },
{ stream_not_start_y, "IR stream start failure" },
{ stream_not_start_cam, "Camera stream start failure" },
{ rec_error, "REC error" },
};
std::vector<platform::uvc_device_info> filter_device_by_capability(const std::vector<platform::uvc_device_info>& devices, d400_caps caps);
const std::vector<uint8_t> alternating_emitter_pattern { 0x19, 0,
0x41, 0x6c, 0x74, 0x65, 0x72, 0x6e, 0x61, 0x74, 0x69, 0x6e, 0x67, 0x5f, 0x45, 0x6d, 0x69, 0x74, 0x74, 0x65, 0x72, 0,
0, 0x2, 0, 0x5, 0, 0x1, 0x1, 0, 0, 0, 0, 0, 0, 0, 0x5, 0, 0x1, 0x1, 0, 0, 0, 0x1, 0, 0, 0 };
} // librealsense::ds
} // namespace librealsense