mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-11-02 17:11:36 +08:00
HoTT: Fix formatting
This commit is contained in:
@@ -104,15 +104,16 @@ int
|
|||||||
recv_data(int uart, uint8_t *buffer, size_t *size, uint8_t *id)
|
recv_data(int uart, uint8_t *buffer, size_t *size, uint8_t *id)
|
||||||
{
|
{
|
||||||
static const int timeout_ms = 1000;
|
static const int timeout_ms = 1000;
|
||||||
|
|
||||||
struct pollfd fds;
|
struct pollfd fds;
|
||||||
fds.fd = uart;
|
fds.fd = uart;
|
||||||
fds.events = POLLIN;
|
fds.events = POLLIN;
|
||||||
|
|
||||||
// XXX should this poll be inside the while loop???
|
// XXX should this poll be inside the while loop???
|
||||||
if (poll(&fds, 1, timeout_ms) > 0) {
|
if (poll(&fds, 1, timeout_ms) > 0) {
|
||||||
int i = 0;
|
int i = 0;
|
||||||
bool stop_byte_read = false;
|
bool stop_byte_read = false;
|
||||||
|
|
||||||
while (true) {
|
while (true) {
|
||||||
read(uart, &buffer[i], sizeof(buffer[i]));
|
read(uart, &buffer[i], sizeof(buffer[i]));
|
||||||
|
|
||||||
@@ -121,14 +122,17 @@ recv_data(int uart, uint8_t *buffer, size_t *size, uint8_t *id)
|
|||||||
*size = ++i;
|
*size = ++i;
|
||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
// XXX can some other field not have the STOP BYTE value?
|
// XXX can some other field not have the STOP BYTE value?
|
||||||
if (buffer[i] == STOP_BYTE) {
|
if (buffer[i] == STOP_BYTE) {
|
||||||
*id = buffer[1];
|
*id = buffer[1];
|
||||||
stop_byte_read = true;
|
stop_byte_read = true;
|
||||||
}
|
}
|
||||||
|
|
||||||
i++;
|
i++;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
return ERROR;
|
return ERROR;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -156,6 +160,7 @@ hott_sensors_thread_main(int argc, char *argv[])
|
|||||||
|
|
||||||
/* enable UART, writes potentially an empty buffer, but multiplexing is disabled */
|
/* enable UART, writes potentially an empty buffer, but multiplexing is disabled */
|
||||||
const int uart = open_uart(device);
|
const int uart = open_uart(device);
|
||||||
|
|
||||||
if (uart < 0) {
|
if (uart < 0) {
|
||||||
errx(1, "Open fail, exiting.");
|
errx(1, "Open fail, exiting.");
|
||||||
thread_running = false;
|
thread_running = false;
|
||||||
@@ -166,6 +171,7 @@ hott_sensors_thread_main(int argc, char *argv[])
|
|||||||
uint8_t buffer[MAX_MESSAGE_BUFFER_SIZE];
|
uint8_t buffer[MAX_MESSAGE_BUFFER_SIZE];
|
||||||
size_t size = 0;
|
size_t size = 0;
|
||||||
uint8_t id = 0;
|
uint8_t id = 0;
|
||||||
|
|
||||||
while (!thread_should_exit) {
|
while (!thread_should_exit) {
|
||||||
// Currently we only support a General Air Module sensor.
|
// Currently we only support a General Air Module sensor.
|
||||||
build_gam_request(&buffer[0], &size);
|
build_gam_request(&buffer[0], &size);
|
||||||
@@ -179,6 +185,7 @@ hott_sensors_thread_main(int argc, char *argv[])
|
|||||||
// Determine which moduel sent it and process accordingly.
|
// Determine which moduel sent it and process accordingly.
|
||||||
if (id == GAM_SENSOR_ID) {
|
if (id == GAM_SENSOR_ID) {
|
||||||
publish_gam_message(buffer);
|
publish_gam_message(buffer);
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
warnx("Unknown sensor ID: %d", id);
|
warnx("Unknown sensor ID: %d", id);
|
||||||
}
|
}
|
||||||
@@ -210,11 +217,11 @@ hott_sensors_main(int argc, char *argv[])
|
|||||||
|
|
||||||
thread_should_exit = false;
|
thread_should_exit = false;
|
||||||
deamon_task = px4_task_spawn_cmd(daemon_name,
|
deamon_task = px4_task_spawn_cmd(daemon_name,
|
||||||
SCHED_DEFAULT,
|
SCHED_DEFAULT,
|
||||||
SCHED_PRIORITY_DEFAULT,
|
SCHED_PRIORITY_DEFAULT,
|
||||||
1024,
|
1024,
|
||||||
hott_sensors_thread_main,
|
hott_sensors_thread_main,
|
||||||
(argv) ? (char * const *)&argv[2] : (char * const *)NULL);
|
(argv) ? (char *const *)&argv[2] : (char *const *)NULL);
|
||||||
exit(0);
|
exit(0);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
@@ -90,7 +90,7 @@ recv_req_id(int uart, uint8_t *id)
|
|||||||
static const int timeout_ms = 1000; // TODO make it a define
|
static const int timeout_ms = 1000; // TODO make it a define
|
||||||
|
|
||||||
uint8_t mode;
|
uint8_t mode;
|
||||||
|
|
||||||
struct pollfd fds;
|
struct pollfd fds;
|
||||||
fds.fd = uart;
|
fds.fd = uart;
|
||||||
fds.events = POLLIN;
|
fds.events = POLLIN;
|
||||||
@@ -106,6 +106,7 @@ recv_req_id(int uart, uint8_t *id)
|
|||||||
|
|
||||||
/* Read the device ID being polled */
|
/* Read the device ID being polled */
|
||||||
read(uart, id, sizeof(*id));
|
read(uart, id, sizeof(*id));
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
warnx("UART timeout on TX/RX port");
|
warnx("UART timeout on TX/RX port");
|
||||||
return ERROR;
|
return ERROR;
|
||||||
@@ -120,6 +121,7 @@ send_data(int uart, uint8_t *buffer, size_t size)
|
|||||||
usleep(POST_READ_DELAY_IN_USECS);
|
usleep(POST_READ_DELAY_IN_USECS);
|
||||||
|
|
||||||
uint16_t checksum = 0;
|
uint16_t checksum = 0;
|
||||||
|
|
||||||
for (size_t i = 0; i < size; i++) {
|
for (size_t i = 0; i < size; i++) {
|
||||||
if (i == size - 1) {
|
if (i == size - 1) {
|
||||||
/* Set the checksum: the first uint8_t is taken as the checksum. */
|
/* Set the checksum: the first uint8_t is taken as the checksum. */
|
||||||
@@ -167,6 +169,7 @@ hott_telemetry_thread_main(int argc, char *argv[])
|
|||||||
|
|
||||||
/* enable UART, writes potentially an empty buffer, but multiplexing is disabled */
|
/* enable UART, writes potentially an empty buffer, but multiplexing is disabled */
|
||||||
const int uart = open_uart(device);
|
const int uart = open_uart(device);
|
||||||
|
|
||||||
if (uart < 0) {
|
if (uart < 0) {
|
||||||
errx(1, "Failed opening HoTT UART, exiting.");
|
errx(1, "Failed opening HoTT UART, exiting.");
|
||||||
thread_running = false;
|
thread_running = false;
|
||||||
@@ -178,6 +181,7 @@ hott_telemetry_thread_main(int argc, char *argv[])
|
|||||||
size_t size = 0;
|
size_t size = 0;
|
||||||
uint8_t id = 0;
|
uint8_t id = 0;
|
||||||
bool connected = true;
|
bool connected = true;
|
||||||
|
|
||||||
while (!thread_should_exit) {
|
while (!thread_should_exit) {
|
||||||
// Listen for and serve poll from the receiver.
|
// Listen for and serve poll from the receiver.
|
||||||
if (recv_req_id(uart, &id) == OK) {
|
if (recv_req_id(uart, &id) == OK) {
|
||||||
@@ -190,9 +194,11 @@ hott_telemetry_thread_main(int argc, char *argv[])
|
|||||||
case EAM_SENSOR_ID:
|
case EAM_SENSOR_ID:
|
||||||
build_eam_response(buffer, &size);
|
build_eam_response(buffer, &size);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case GAM_SENSOR_ID:
|
case GAM_SENSOR_ID:
|
||||||
build_gam_response(buffer, &size);
|
build_gam_response(buffer, &size);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case GPS_SENSOR_ID:
|
case GPS_SENSOR_ID:
|
||||||
build_gps_response(buffer, &size);
|
build_gps_response(buffer, &size);
|
||||||
break;
|
break;
|
||||||
@@ -202,6 +208,7 @@ hott_telemetry_thread_main(int argc, char *argv[])
|
|||||||
}
|
}
|
||||||
|
|
||||||
send_data(uart, buffer, size);
|
send_data(uart, buffer, size);
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
connected = false;
|
connected = false;
|
||||||
warnx("syncing");
|
warnx("syncing");
|
||||||
@@ -236,11 +243,11 @@ hott_telemetry_main(int argc, char *argv[])
|
|||||||
|
|
||||||
thread_should_exit = false;
|
thread_should_exit = false;
|
||||||
deamon_task = px4_task_spawn_cmd(daemon_name,
|
deamon_task = px4_task_spawn_cmd(daemon_name,
|
||||||
SCHED_DEFAULT,
|
SCHED_DEFAULT,
|
||||||
SCHED_PRIORITY_DEFAULT,
|
SCHED_PRIORITY_DEFAULT,
|
||||||
2048,
|
2048,
|
||||||
hott_telemetry_thread_main,
|
hott_telemetry_thread_main,
|
||||||
(argv) ? (char * const *)&argv[2] : (char * const *)NULL);
|
(argv) ? (char *const *)&argv[2] : (char *const *)NULL);
|
||||||
exit(0);
|
exit(0);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user