File tree Expand file tree Collapse file tree 1 file changed +8
-5
lines changed Expand file tree Collapse file tree 1 file changed +8
-5
lines changed Original file line number Diff line number Diff line change @@ -65,22 +65,25 @@ ScanPacket Sweep::getReading(bool &success)
65
65
if (_readResponseScanPacket ())
66
66
{
67
67
// TODO: validate receipt
68
- int i = 0 ;
68
+ uint8_t i = 0 ;
69
69
70
70
bool bIsSync = _responseScanPacket[i++] & _SYNC_MASK;
71
71
72
- uint16_t angle_lsb = _responseScanPacket[i++];
73
- uint16_t angle_msb = _responseScanPacket[i++] << 8 ;
74
- uint16_t angle = angle_lsb + angle_msb;
72
+ // read raw fixed point azimuth value
73
+ uint16_t rawAngle_lsb = _responseScanPacket[i++];
74
+ uint16_t rawAngle_msb = _responseScanPacket[i++] << 8 ;
75
+ uint16_t rawAngle = rawAngle_lsb + rawAngle_msb;
75
76
77
+ // read distance value
76
78
uint16_t distance_lsb = _responseScanPacket[i++];
77
79
uint16_t distance_msb = _responseScanPacket[i++] << 8 ;
78
80
uint16_t distance = distance_lsb + distance_msb;
79
81
82
+ // read signal strength value
80
83
uint8_t signalStrength = _responseScanPacket[i++];
81
84
82
85
success = true ;
83
- return ScanPacket (bIsSync, angle , distance, signalStrength);
86
+ return ScanPacket (bIsSync, rawAngle , distance, signalStrength);
84
87
}
85
88
86
89
return ScanPacket (false , 0 , 0 , 0 );
You can’t perform that action at this time.
0 commit comments