/**
* Поиск индексов в массиве настроек
*/
static void search_indexes(void){
xoffset = ValueSearch("ACC_xoffset");
yoffset = ValueSearch("ACC_yoffset");
zoffset = ValueSearch("ACC_zoffset");
xpol = ValueSearch("ACC_xpol");
ypol = ValueSearch("ACC_ypol");
zpol = ValueSearch("ACC_zpol");
xsens = ValueSearch("ACC_xsens");
ysens = ValueSearch("ACC_ysens");
zsens = ValueSearch("ACC_zsens");
}
void MavInit(void) {
/* initial mavlink values */
mavlink_system_struct.sysid = *(uint8_t *)ValueSearch("SYS_ID");
mavlink_system_struct.compid = MAV_COMP_ID_SYSTEM_CONTROL;//MAV_COMP_ID_BNAP;
mavlink_system_struct.state = MAV_STATE_ACTIVE;
mavlink_system_struct.mode = MAV_MODE_PREFLIGHT;
mavlink_system_struct.type = MAV_TYPE_GROUND_ROVER;
}
/*
*******************************************************************************
* EXPORTED FUNCTIONS
*******************************************************************************
*/
void DmCliSwitcherInit(SerialDriver *sdp){
sh_enable = ValueSearch("SH_enable");
chThdCreateStatic(DmCliSwitcherThreadWA,
sizeof(DmCliSwitcherThreadWA),
NORMALPRIO,
DmCliSwitcherThread,
sdp);
}