void
rctl_disarm(rctl_link_t *link) {
if (!mav_armed) return;
printf("disarming\n");
SET_MODE(baseMode & ~MAV_MODE_FLAG_SAFETY_ARMED, navMode);
mav_armed = false;
}
void
rctl_arm(rctl_link_t *link) {
if (mav_armed) return;
printf("arming\n");
SET_MODE(baseMode | MAV_MODE_FLAG_SAFETY_ARMED, navMode);
mav_armed = true;
}
void owl_context_set_interactive(owl_context *ctx)
{
SET_MODE(ctx, OWL_CTX_INTERACTIVE);
}
void owl_context_set_readconfig(owl_context *ctx)
{
SET_MODE(ctx, OWL_CTX_READCONFIG);
}
void owl_context_set_startup(owl_context *ctx)
{
SET_MODE(ctx, OWL_CTX_STARTUP);
}
void
_mavlink_set_initial_mode(rctl_link_t *link) {
printf("set mode\n");
uint8_t mode = MAV_MODE_FLAG_MANUAL_INPUT_ENABLED;
SET_MODE(mode & ~MAV_MODE_FLAG_SAFETY_ARMED, baseMode);
}
