26{
27
28 if (!constants::MODE_SIM)
29 {
30
31 m_pMainCam = std::make_shared<ZEDCam>(constants::ZED_MAINCAM_RESOLUTIONX,
32 constants::ZED_MAINCAM_RESOLUTIONY,
33 constants::ZED_MAINCAM_FPS,
34 constants::ZED_MAINCAM_HORIZONTAL_FOV,
35 constants::ZED_MAINCAM_VERTICAL_FOV,
36 constants::ZED_MAINCAM_ENABLE_RECORDING,
37 constants::ZED_MAINCAM_EXPORT_SVO_RECORDING,
38 constants::ZED_DEFAULT_MINIMUM_DISTANCE,
39 constants::ZED_DEFAULT_MAXIMUM_DISTANCE,
40 constants::ZED_MAINCAM_USE_GPU_MAT,
41 constants::ZED_MAINCAM_USE_HALF_PRECISION_DEPTH,
42 constants::ZED_MAINCAM_FRAME_RETRIEVAL_THREADS,
43 constants::ZED_MAINCAM_SERIAL);
44
45
46 if (constants::ZED_MAINCAM_EXPORT_SPATIAL_MAP)
47 {
48 m_pMainCam->EnableSpatialMapping();
49 }
50
51
52 m_pRearCam = std::make_shared<ZEDCam>(constants::ZED_REARCAM_RESOLUTIONX,
53 constants::ZED_REARCAM_RESOLUTIONY,
54 constants::ZED_REARCAM_FPS,
55 constants::ZED_REARCAM_HORIZONTAL_FOV,
56 constants::ZED_REARCAM_VERTICAL_FOV,
57 constants::ZED_REARCAM_ENABLE_RECORDING,
58 constants::ZED_REARCAM_EXPORT_SVO_RECORDING,
59 constants::ZED_DEFAULT_MINIMUM_DISTANCE,
60 constants::ZED_DEFAULT_MAXIMUM_DISTANCE,
61 constants::ZED_REARCAM_USE_GPU_MAT,
62 constants::ZED_REARCAM_USE_HALF_PRECISION_DEPTH,
63 constants::ZED_REARCAM_FRAME_RETRIEVAL_THREADS,
64 constants::ZED_REARCAM_SERIAL);
65
66
67 if (constants::ZED_REARCAM_EXPORT_SPATIAL_MAP)
68 {
69 m_pRearCam->EnableSpatialMapping();
70 }
71 }
72 else
73 {
74 m_pMainCam =
75 std::make_shared<SIMZEDCam>("ws://" + constants::SIM_IP_ADDRESS + ":" + std::to_string(constants::SIM_WEBSOCKET_PORT) + "/" + constants::SIM_MAINCAM_NAME,
76 constants::ZED_MAINCAM_RESOLUTIONX,
77 constants::ZED_MAINCAM_RESOLUTIONY,
78 constants::ZED_MAINCAM_FPS,
79 constants::ZED_MAINCAM_HORIZONTAL_FOV,
80 constants::ZED_MAINCAM_VERTICAL_FOV,
81 constants::ZED_MAINCAM_ENABLE_RECORDING,
82 constants::ZED_MAINCAM_FRAME_RETRIEVAL_THREADS,
83 constants::ZED_MAINCAM_SERIAL);
84
85 m_pRearCam =
86 std::make_shared<SIMZEDCam>("ws://" + constants::SIM_IP_ADDRESS + ":" + std::to_string(constants::SIM_WEBSOCKET_PORT) + "/" + constants::SIM_REARCAM_NAME,
87 constants::ZED_REARCAM_RESOLUTIONX,
88 constants::ZED_REARCAM_RESOLUTIONY,
89 constants::ZED_REARCAM_FPS,
90 constants::ZED_REARCAM_HORIZONTAL_FOV,
91 constants::ZED_REARCAM_VERTICAL_FOV,
92 constants::ZED_REARCAM_ENABLE_RECORDING,
93 constants::ZED_REARCAM_FRAME_RETRIEVAL_THREADS,
94 constants::ZED_REARCAM_SERIAL);
95 }
96
97
98 m_pMainCam->SetCameraPoseOffset(constants::ZED_MAINCAM_EASTING_OFFSET,
99 constants::ZED_MAINCAM_NORTHING_OFFSET,
100 constants::ZED_MAINCAM_ALTITUDE_OFFSET,
101 constants::ZED_MAINCAM_QUATERNION_OFFSET_X,
102 constants::ZED_MAINCAM_QUATERNION_OFFSET_Y,
103 constants::ZED_MAINCAM_QUATERNION_OFFSET_Z,
104 constants::ZED_MAINCAM_QUATERNION_OFFSET_W);
105
106
107 m_pRearCam->SetCameraPoseOffset(constants::ZED_REARCAM_EASTING_OFFSET,
108 constants::ZED_REARCAM_NORTHING_OFFSET,
109 constants::ZED_REARCAM_ALTITUDE_OFFSET,
110 constants::ZED_REARCAM_QUATERNION_OFFSET_X,
111 constants::ZED_REARCAM_QUATERNION_OFFSET_Y,
112 constants::ZED_REARCAM_QUATERNION_OFFSET_Z,
113 constants::ZED_REARCAM_QUATERNION_OFFSET_W);
114
115
116
121
122
123 m_pRecordingHandler = std::make_unique<RecordingHandler>(RecordingHandler::RecordingMode::eCameraHandler);
124}
Interface class used to easily multithread a child class.
Definition AutonomyThread.hpp:40