/*!
If this program run as console mode, measurement result will be displayed
on console terminal.
@return If this function succeeds, the return value is #AKM_SUCCESS.
Otherwise the return value is #AKM_FAIL.
*/
void AKFS_OutputResult(
const uint16 flag,
const AKSENSOR_DATA* acc,
const AKSENSOR_DATA* mag,
const AKSENSOR_DATA* ori
)
{
int buf[YPR_DATA_SIZE];
/* Store to buffer */
buf[0] = flag; /* Data flag */
buf[1] = CONVERT_ACC(acc->x); /* Ax */
buf[2] = CONVERT_ACC(acc->y); /* Ay */
buf[3] = CONVERT_ACC(acc->z); /* Az */
buf[4] = acc->status; /* Acc status */
buf[5] = CONVERT_MAG(mag->x); /* Mx */
buf[6] = CONVERT_MAG(mag->y); /* My */
buf[7] = CONVERT_MAG(mag->z); /* Mz */
buf[8] = mag->status; /* Mag status */
buf[9] = CONVERT_ORI(ori->x); /* yaw */
buf[10] = CONVERT_ORI(ori->y); /* pitch */
buf[11] = CONVERT_ORI(ori->z); /* roll */
if (g_opmode & OPMODE_CONSOLE) {
/* Console mode */
Disp_Result(buf);
}
/* Set result to driver */
AKD_SetYPR(buf);
}
/*!
If this program run as console mode, measurement result will be displayed
on console terminal.
@return None.
*/
void AKFS_OutputResult(
const uint16 flag,
const AKSENSOR_DATA* acc,
const AKSENSOR_DATA* mag,
const AKSENSOR_DATA* ori
)
{
int buf[AKM_YPR_DATA_SIZE];
#ifdef AKM_VALUE_CHECK
if (AKM_YPR_DATA_SIZE < 12) {
AKMERROR_STR("You may refer invalid header file.");
return;
}
#endif
/* Store to buffer */
buf[0] = flag; /* Data flag */
buf[1] = CONVERT_ACC(acc->x); /* Ax */
buf[2] = CONVERT_ACC(acc->y); /* Ay */
buf[3] = CONVERT_ACC(acc->z); /* Az */
buf[4] = acc->status; /* Acc status */
buf[5] = CONVERT_MAG(mag->x); /* Mx */
buf[6] = CONVERT_MAG(mag->y); /* My */
buf[7] = CONVERT_MAG(mag->z); /* Mz */
buf[8] = mag->status; /* Mag status */
buf[9] = CONVERT_ORI(ori->x); /* yaw */
buf[10] = CONVERT_ORI(ori->y); /* pitch */
buf[11] = CONVERT_ORI(ori->z); /* roll */
if (g_opmode & OPMODE_CONSOLE) {
/* Console mode */
Disp_Result(buf);
}
/* Set result to driver */
AKD_SetYPR(buf);
}
