|
|
|
@ -431,7 +431,6 @@ void Morse::update(const struct sitl_input &input)
@@ -431,7 +431,6 @@ void Morse::update(const struct sitl_input &input)
|
|
|
|
|
// cope with restarting while connected
|
|
|
|
|
initial_time_s = time_now_us * 1.0e-6f; |
|
|
|
|
last_time_s = state.timestamp; |
|
|
|
|
position_offset.zero(); |
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -490,12 +489,6 @@ void Morse::update(const struct sitl_input &input)
@@ -490,12 +489,6 @@ void Morse::update(const struct sitl_input &input)
|
|
|
|
|
scanner.points = state.scanner.points; |
|
|
|
|
scanner.ranges = state.scanner.ranges; |
|
|
|
|
|
|
|
|
|
// offset based on first position to account for offset in morse world
|
|
|
|
|
if (position_offset.is_zero()) { |
|
|
|
|
position_offset = position; |
|
|
|
|
} |
|
|
|
|
position -= position_offset; |
|
|
|
|
|
|
|
|
|
update_position(); |
|
|
|
|
time_advance(); |
|
|
|
|
uint64_t new_time_us = (state.timestamp - initial_time_s)*1.0e6; |
|
|
|
|