MAVLink app: Use right lookup function

This commit is contained in:
Lorenz Meier 2015-04-26 14:02:06 +02:00
parent 36ca62ece9
commit 76ce611e84
1 changed files with 2 additions and 1 deletions

View File

@ -130,7 +130,7 @@ MavlinkParametersManager::handle_message(const mavlink_message_t *msg)
} else { } else {
/* when index is >= 0, send this parameter again */ /* when index is >= 0, send this parameter again */
send_param(param_for_index(req_read.param_index)); send_param(param_for_used_index(req_read.param_index));
} }
} }
break; break;
@ -192,6 +192,7 @@ MavlinkParametersManager::send(const hrt_abstime t)
/* look for the first parameter which is used */ /* look for the first parameter which is used */
param_t p; param_t p;
do { do {
/* walk through all parameters, including unused ones */
p = param_for_index(_send_all_index); p = param_for_index(_send_all_index);
_send_all_index++; _send_all_index++;
} while (p != PARAM_INVALID && !param_used(p)); } while (p != PARAM_INVALID && !param_used(p));