refactor: replace vision error_x/y with measure/ref in 0xA5 frame
Change 0xA5 frame from 2-float (error_x, error_y) to 4-float (measure_x, ref_x, measure_y, ref_y) so PIDCalculate receives actual measurement and reference values internally computing error.
This commit is contained in:
@@ -29,8 +29,10 @@ static void DecodeVision()
|
||||
{
|
||||
if (calc_checksum(buf, VISION_AUTO_LEN) != buf[VISION_AUTO_LEN - 1])
|
||||
return;
|
||||
memcpy(&vision_data.error_x, buf + 1, 4);
|
||||
memcpy(&vision_data.error_y, buf + 5, 4);
|
||||
memcpy(&vision_data.measure_x, buf + 1, 4);
|
||||
memcpy(&vision_data.ref_x, buf + 5, 4);
|
||||
memcpy(&vision_data.measure_y, buf + 9, 4);
|
||||
memcpy(&vision_data.ref_y, buf + 13, 4);
|
||||
vision_data.auto_updated = 1;
|
||||
}
|
||||
else if (sof == VISION_SOF_MANUAL && len == VISION_MANUAL_LEN)
|
||||
|
||||
Reference in New Issue
Block a user