SITL: correct PS_LightWare_SF45B simulator

This commit is contained in:
Peter Barker 2022-02-16 17:00:04 +11:00 committed by Peter Barker
parent 6521bc31c7
commit 4afc14007b
1 changed files with 1 additions and 1 deletions

View File

@ -216,7 +216,7 @@ void PS_LightWare_SF45B::update_output_scan(const Location &location)
PackedMessage<DistanceDataCM> packed_distance_data {
DistanceDataCM(
uint16_t(distance*100.0),
uint16_t(current_degrees_bf * 100)
wrap_180(current_degrees_bf) * 100
), 0x1 };
packed_distance_data.update_checksum();
send((char*)&packed_distance_data, sizeof(packed_distance_data));