fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

Iridium: Remove lengthy test content

Browse Source 
And also format file according to code style.
This commit is contained in:
Lorenz Meier 2018-01-13 18:49:32 +01:00 committed by Daniel Agar
parent be4be6db2c
commit bc487c7c36
1 changed files with 36 additions and 38 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

74
src/drivers/iridiumsbd/IridiumSBD.cpp
View File

@ -257,58 +257,56 @@ void IridiumSBD::standby_loop(void)
if (test_pending) {
test_pending = false;
if (!strcmp(test_command, "s")) {
write(0, "kreczmer", 8);
} else if (!strcmp(test_command, "ss")) {
write(0, "kreczmerkreczmerkreczmerkreczmerkreczmerkreczmerkreczmerkreczmerkreczmerkreczmerkreczmerkreczmer!!!!!!", 100);
} else if (!strcmp(test_command, "read")) {
rx_session_pending = true;
} else {
test_timer = hrt_absolute_time();
start_test();
return;
}
}
// check for incoming SBDRING, handled inside read_at_command()
read_at_command();
if (param_read_interval_s != 0 && ((int64_t)(hrt_absolute_time() - last_read_time) > param_read_interval_s * 1000000)) {
} else if (!strcmp(test_command, "read")) {
rx_session_pending = true;
} else {
test_timer = hrt_absolute_time();
start_test();
return;
}
}
// write the MO buffer when the message stacking time expires
if ((tx_buf_write_idx > 0) && (hrt_absolute_time() - last_write_time > SATCOM_TX_STACKING_TIME)) {
write_tx_buf();
}
// check for incoming SBDRING, handled inside read_at_command()
read_at_command();
// do not start an SBD session if there is still data in the MT buffer, or it will be lost
if ((tx_session_pending || rx_session_pending) && !rx_read_pending) {
if (hrt_absolute_time() - last_signal_check < SATCOM_SIGNAL_REFRESH_DELAY && signal_quality > 0) {
// clear the MO buffer if we only want to read a message
if (rx_session_pending && !tx_session_pending) {
if (clear_mo_buffer()) {
start_sbd_session();
}
if (param_read_interval_s != 0 && ((int64_t)(hrt_absolute_time() - last_read_time) > param_read_interval_s * 1000000))
{
rx_session_pending = true;
}
} else {
// write the MO buffer when the message stacking time expires
if ((tx_buf_write_idx > 0) && (hrt_absolute_time() - last_write_time > SATCOM_TX_STACKING_TIME))
{
write_tx_buf();
}
// do not start an SBD session if there is still data in the MT buffer, or it will be lost
if ((tx_session_pending || rx_session_pending) && !rx_read_pending)
{
if (hrt_absolute_time() - last_signal_check < SATCOM_SIGNAL_REFRESH_DELAY && signal_quality > 0) {
// clear the MO buffer if we only want to read a message
if (rx_session_pending && !tx_session_pending) {
if (clear_mo_buffer()) {
start_sbd_session();
}
} else {
start_csq();
start_sbd_session();
}
}
// only read the MT buffer if the higher layer (mavlink app) read the previous message
if (rx_read_pending && (rx_msg_read_idx == rx_msg_end_idx)) {
read_rx_buf();
} else {
start_csq();
}
}
// only read the MT buffer if the higher layer (mavlink app) read the previous message
if (rx_read_pending && (rx_msg_read_idx == rx_msg_end_idx))
{
read_rx_buf();
}
}
void IridiumSBD::csq_loop(void)
{
int res = read_at_command();