/*! 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); }