@@ -79,6 +79,22 @@ void SensorParamHandler::declareParams(std::shared_ptr<dai::node::MonoCamera> mo
79
79
}
80
80
monoCam->setImageOrientation (
81
81
utils::getValFromMap (declareAndLogParam<std::string>(" i_sensor_img_orientation" , " AUTO" ), dai_nodes::sensor_helpers::cameraImageOrientationMap));
82
+ int expLimit = declareAndLogParam<int >(" r_auto_exposure_limit" , 1000 );
83
+ if (declareAndLogParam<bool >(" r_set_auto_exposure_limit" , false )) {
84
+ monoCam->initialControl .setAutoExposureLimit (expLimit);
85
+ }
86
+ int sharpness = declareAndLogParam<int >(" r_sharpness" , 1 );
87
+ if (declareAndLogParam (" r_set_sharpness" , false )) {
88
+ monoCam->initialControl .setSharpness (sharpness);
89
+ }
90
+ int chromaDenoise = declareAndLogParam<int >(" r_chroma_denoise" , 1 );
91
+ if (declareAndLogParam (" r_set_chroma_denoise" , false )) {
92
+ monoCam->initialControl .setChromaDenoise (chromaDenoise);
93
+ }
94
+ int lumaDenoise = declareAndLogParam<int >(" r_luma_denoise" , 1 );
95
+ if (declareAndLogParam (" r_set_luma_denoise" , false )) {
96
+ monoCam->initialControl .setLumaDenoise (lumaDenoise);
97
+ }
82
98
}
83
99
void SensorParamHandler::declareParams (std::shared_ptr<dai::node::ColorCamera> colorCam, dai_nodes::sensor_helpers::ImageSensor sensor, bool publish) {
84
100
declareAndLogParam<bool >(" i_publish_topic" , publish);
@@ -178,6 +194,22 @@ void SensorParamHandler::declareParams(std::shared_ptr<dai::node::ColorCamera> c
178
194
}
179
195
colorCam->setImageOrientation (
180
196
utils::getValFromMap (declareAndLogParam<std::string>(" i_sensor_img_orientation" , " AUTO" ), dai_nodes::sensor_helpers::cameraImageOrientationMap));
197
+ int expLimit = declareAndLogParam<int >(" r_auto_exposure_limit" , 1000 );
198
+ if (declareAndLogParam<bool >(" r_set_auto_exposure_limit" , false )) {
199
+ colorCam->initialControl .setAutoExposureLimit (expLimit);
200
+ }
201
+ int sharpness = declareAndLogParam<int >(" r_sharpness" , 1 );
202
+ if (declareAndLogParam (" r_set_sharpness" , false )) {
203
+ colorCam->initialControl .setSharpness (sharpness);
204
+ }
205
+ int chromaDenoise = declareAndLogParam<int >(" r_chroma_denoise" , 1 );
206
+ if (declareAndLogParam (" r_set_chroma_denoise" , false )) {
207
+ colorCam->initialControl .setChromaDenoise (chromaDenoise);
208
+ }
209
+ int lumaDenoise = declareAndLogParam<int >(" r_luma_denoise" , 1 );
210
+ if (declareAndLogParam (" r_set_luma_denoise" , false )) {
211
+ colorCam->initialControl .setLumaDenoise (lumaDenoise);
212
+ }
181
213
}
182
214
dai::CameraControl SensorParamHandler::setRuntimeParams (const std::vector<rclcpp::Parameter>& params) {
183
215
dai::CameraControl ctrl;
@@ -216,6 +248,38 @@ dai::CameraControl SensorParamHandler::setRuntimeParams(const std::vector<rclcpp
216
248
if (getParam<bool >(" r_set_man_whitebalance" )) {
217
249
ctrl.setManualWhiteBalance (p.get_value <int >());
218
250
}
251
+ } else if (p.get_name () == getFullParamName (" r_set_auto_exposure_limit" )) {
252
+ if (p.get_value <bool >()) {
253
+ ctrl.setAutoExposureLimit (getParam<int >(" r_auto_exposure_limit" ));
254
+ }
255
+ } else if (p.get_name () == getFullParamName (" r_auto_exposure_limit" )) {
256
+ if (getParam<bool >(" r_set_auto_exposure_limit" )) {
257
+ ctrl.setAutoExposureLimit (p.get_value <int >());
258
+ }
259
+ } else if (p.get_name () == getFullParamName (" r_set_sharpness" )) {
260
+ if (p.get_value <bool >()) {
261
+ ctrl.setSharpness (getParam<int >(" r_sharpness" ));
262
+ }
263
+ } else if (p.get_name () == getFullParamName (" r_sharpness" )) {
264
+ if (getParam<bool >(" r_set_sharpness" )) {
265
+ ctrl.setSharpness (p.get_value <int >());
266
+ }
267
+ } else if (p.get_name () == getFullParamName (" r_set_chroma_denoise" )) {
268
+ if (p.get_value <bool >()) {
269
+ ctrl.setChromaDenoise (getParam<int >(" r_chroma_denoise" ));
270
+ }
271
+ } else if (p.get_name () == getFullParamName (" r_chroma_denoise" )) {
272
+ if (getParam<bool >(" r_set_chroma_denoise" )) {
273
+ ctrl.setChromaDenoise (p.get_value <int >());
274
+ }
275
+ } else if (p.get_name () == getFullParamName (" r_set_luma_denoise" )) {
276
+ if (p.get_value <bool >()) {
277
+ ctrl.setLumaDenoise (getParam<int >(" r_luma_denoise" ));
278
+ }
279
+ } else if (p.get_name () == getFullParamName (" r_luma_denoise" )) {
280
+ if (getParam<bool >(" r_set_luma_denoise" )) {
281
+ ctrl.setLumaDenoise (p.get_value <int >());
282
+ }
219
283
}
220
284
}
221
285
return ctrl;
0 commit comments