ATOF_POINT_DATA
Detected points expressed as Angle and Time of Flight
ID: 3012
Payload Definition
Data Type
Name
Description
struct atof_t {
float angle; // radians, positive to port
float tof; // seconds, time of flight
u32 reserved[2];
}
// float distance = 0.5 * speed_of_sound * tof_sec;
// float y = distance * sin(angle);
// float z = -distance * cos(angle);Last updated