+ static const int camer_input_min = -1000;
+ static const int camer_input_max = 1000;
+ static const int camer_azimuth_min = 200;
+ static const int camer_azimuth_max = 700;
+ static const int camer_elevation_min = 200;
+ static const int camer_elevation_max = 400;
+
+ int val_azimuth = __map_range_val(camer_input_min, camer_input_max, camer_azimuth_min, camer_azimuth_max, azimuth);
+ int val_elevation = __map_range_val(0, camer_input_max, camer_elevation_min, camer_elevation_max, elevation); // No need to look upside down
+
+ _D("camera - azimuth[%4d : %4d], elevation[%4d : %4d]", azimuth, val_azimuth, elevation, val_elevation);
+#if ENABLE_MOTOR
+ resource_set_servo_motor_value(14, val_elevation);
+ resource_set_servo_motor_value(15, val_azimuth);
+#endif