diff --git a/MAVProxy/modules/mavproxy_terrain.py b/MAVProxy/modules/mavproxy_terrain.py index 9a31d6de65..4b38baffc9 100644 --- a/MAVProxy/modules/mavproxy_terrain.py +++ b/MAVProxy/modules/mavproxy_terrain.py @@ -26,6 +26,7 @@ def __init__(self, mpstate): self.terrain_settings = mp_settings.MPSettings([('debug', int, 0), ('enable', int, 1), ('offline', int, 0), + ('terrain_data_rate', int, 5), mp_settings.MPSetting('source', str, "SRTM3", choice=mp_elevation.TERRAIN_SERVICES.keys())]) self.add_completion_function('(TERRAINSETTING)', self.terrain_settings.completion) @@ -135,8 +136,11 @@ def idle_task(self): '''called when idle''' if self.current_request is None: return - if time.time() - self.last_send_time < 0.2: - # limit to 5 per second + if self.terrain_settings.terrain_data_rate <= 0: + # disabled + return + if time.time() - self.last_send_time < 1/self.terrain_settings.terrain_data_rate: + # limit rate according to parameter return self.send_terrain_data()