334 lines
10 KiB
C
334 lines
10 KiB
C
|
/******************************************************************************
|
||
|
|
*
|
||
|
|
* $Id: FileIO.c 303 2011-08-12 04:22:45Z kihara.gb $
|
||
|
|
*
|
||
|
|
* -- Copyright Notice --
|
||
|
|
*
|
||
|
|
* Copyright (c) 2004 Asahi Kasei Microdevices Corporation, Japan
|
||
|
|
* All Rights Reserved.
|
||
|
|
*
|
||
|
|
* This software program is proprietary program of Asahi Kasei Microdevices
|
||
|
|
* Corporation("AKM") licensed to authorized Licensee under Software License
|
||
|
|
* Agreement (SLA) executed between the Licensee and AKM.
|
||
|
|
*
|
||
|
|
* Use of the software by unauthorized third party, or use of the software
|
||
|
|
* beyond the scope of the SLA is strictly prohibited.
|
||
|
|
*
|
||
|
|
* -- End Asahi Kasei Microdevices Copyright Notice --
|
||
|
|
*
|
||
|
|
******************************************************************************/
|
||
|
|
#include "FileIO.h"
|
||
|
|
|
||
|
|
/*!
|
||
|
|
Load parameters from file which is specified with #CSPEC_SETTING_FILE.
|
||
|
|
This function reads data from a beginning of the file line by line, and
|
||
|
|
check parameter name sequentially. In otherword, this function depends on
|
||
|
|
the order of eache parameter described in the file.
|
||
|
|
@return If function fails, the return value is 0. When function fails, the
|
||
|
|
output is undefined. Therefore, parameters which are possibly overwritten
|
||
|
|
by this function should be initialized again. If function succeeds, the
|
||
|
|
return value is 1.
|
||
|
|
@param[out] prms A pointer to #AK8963PRMS structure. Loaded parameter is
|
||
|
|
stored to the member of this structure.
|
||
|
|
*/
|
||
|
|
int16 LoadParameters(AK8963PRMS * prms)
|
||
|
|
{
|
||
|
|
int16 tmp, ret;
|
||
|
|
int16 i;
|
||
|
|
FILE *fp = NULL;
|
||
|
|
char keyName[64];
|
||
|
|
|
||
|
|
//Open setting file for read.
|
||
|
|
if ((fp = fopen(CSPEC_SETTING_FILE, "r")) == NULL) {
|
||
|
|
AKMERROR_STR("fopen");
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
ret = 1;
|
||
|
|
|
||
|
|
// Load data to HDST, HO, HREF, THRE
|
||
|
|
for (i = 0; i < CSPEC_NUM_FORMATION; i++) {
|
||
|
|
snprintf(keyName, sizeof(keyName), "HSUC_HDST_FORM%d", i);
|
||
|
|
tmp = 0;
|
||
|
|
ret = ret && LoadInt16(fp, keyName, &tmp);
|
||
|
|
prms->HSUC_HDST[i] = (AKSC_HDST)tmp;
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "HSUC_HO_FORM%d", i);
|
||
|
|
ret = ret && LoadInt16vec(fp, keyName, &prms->HSUC_HO[i]);
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "HFLUCV_HREF_FORM%d", i);
|
||
|
|
ret = ret && LoadInt16vec(fp, keyName, &prms->HFLUCV_HREF[i]);
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "HSUC_HBASE_FORM%d", i);
|
||
|
|
ret = ret && LoadInt32vec(fp, keyName, &prms->HSUC_HBASE[i]);
|
||
|
|
}
|
||
|
|
|
||
|
|
if (fclose(fp) != 0) {
|
||
|
|
AKMERROR_STR("fclose");
|
||
|
|
ret = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (ret == 0) {
|
||
|
|
ALOGE("%s: failed.", __FUNCTION__);
|
||
|
|
}
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*!
|
||
|
|
Load \c int type value from file. The name of parameter is specified with
|
||
|
|
\a lpKeyName. If the name matches the beginning of read line, the string
|
||
|
|
after #DELIMITER will converted to \c int type value.
|
||
|
|
@return If function fails, the return value is 0. When function fails, the
|
||
|
|
value @ val is not overwritten. If function succeeds, the return value is 1.
|
||
|
|
@param[in] fp Pointer to \c FILE structure.
|
||
|
|
@param[in] lpKeyName The name of parameter.
|
||
|
|
@param[out] val Pointer to \c int type value. Upon successful completion
|
||
|
|
of this function, read value is copied to this variable.
|
||
|
|
*/
|
||
|
|
int16 LoadInt(FILE * fp, const char *lpKeyName, int *val)
|
||
|
|
{
|
||
|
|
char buf[64] = { '\0' };
|
||
|
|
|
||
|
|
// ATTENTION! %ns should be modified according to the size of buf.
|
||
|
|
if (fscanf(fp, "%63s" DELIMITER "%11d", buf, val) != 2) {
|
||
|
|
ALOGE("%s: scanf error.", __FUNCTION__);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
// Compare the read parameter name with given name.
|
||
|
|
if (strncmp(buf, lpKeyName, sizeof(buf)) != 0) {
|
||
|
|
ALOGE("%s: strncmp (%s) error.", __FUNCTION__, lpKeyName);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*! Same as LoadInt().*/
|
||
|
|
int16 LoadInt16(FILE * fp, const char *lpKeyName, int16 *val)
|
||
|
|
{
|
||
|
|
int tmp;
|
||
|
|
|
||
|
|
if (LoadInt(fp, lpKeyName, &tmp) != 1) {
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
*val = (int16)tmp;
|
||
|
|
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*! Same as LoadInt().*/
|
||
|
|
int16 LoadInt32(FILE * fp, const char *lpKeyName, int32 *val)
|
||
|
|
{
|
||
|
|
int tmp;
|
||
|
|
|
||
|
|
if (LoadInt(fp, lpKeyName, &tmp) != 1) {
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
*val = (int32)tmp;
|
||
|
|
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*!
|
||
|
|
Load \c int16vec type value from file and convert it to int16vec type
|
||
|
|
structure. This function adds ".x", ".y" and ".z" to the last of parameter
|
||
|
|
name and try to read value with combined name.
|
||
|
|
@return If function fails, the return value is 0. When function fails, the
|
||
|
|
output is undefined. If function succeeds, the return value is 1.
|
||
|
|
@param[in] fp A opened \c FILE pointer.
|
||
|
|
@param[in] lpKeyName The parameter name.
|
||
|
|
@param[out] vec A pointer to int16vec structure. Upon successful completion
|
||
|
|
of this function, read values are copied to this variable.
|
||
|
|
*/
|
||
|
|
int16 LoadInt16vec(FILE * fp, const char *lpKeyName, int16vec * vec)
|
||
|
|
{
|
||
|
|
char keyName[64];
|
||
|
|
int16 ret = 1;
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "%s.x", lpKeyName);
|
||
|
|
ret = ret && LoadInt16(fp, keyName, &vec->u.x);
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "%s.y", lpKeyName);
|
||
|
|
ret = ret && LoadInt16(fp, keyName, &vec->u.y);
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "%s.z", lpKeyName);
|
||
|
|
ret = ret && LoadInt16(fp, keyName, &vec->u.z);
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*!
|
||
|
|
Load \c int32vec type value from file and convert it to int32vec type
|
||
|
|
structure. This function adds ".x", ".y" and ".z" to the last of parameter
|
||
|
|
name and try to read value with combined name.
|
||
|
|
@return If function fails, the return value is 0. When function fails, the
|
||
|
|
output is undefined. If function succeeds, the return value is 1.
|
||
|
|
@param[in] fp A opened \c FILE pointer.
|
||
|
|
@param[in] lpKeyName The parameter name.
|
||
|
|
@param[out] vec A pointer to int32vec structure. Upon successful completion
|
||
|
|
of this function, read values are copied to this variable.
|
||
|
|
*/
|
||
|
|
int16 LoadInt32vec(FILE * fp, const char *lpKeyName, int32vec * vec)
|
||
|
|
{
|
||
|
|
char keyName[64];
|
||
|
|
int16 ret = 1;
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "%s.x", lpKeyName);
|
||
|
|
ret = ret && LoadInt32(fp, keyName, &vec->u.x);
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "%s.y", lpKeyName);
|
||
|
|
ret = ret && LoadInt32(fp, keyName, &vec->u.y);
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "%s.z", lpKeyName);
|
||
|
|
ret = ret && LoadInt32(fp, keyName, &vec->u.z);
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
/*!
|
||
|
|
Save parameters to file which is specified with #CSPEC_SETTING_FILE. This
|
||
|
|
function saves variables when the offsets of magnetic sensor estimated
|
||
|
|
successfully.
|
||
|
|
@return If function fails, the return value is 0. When function fails, the
|
||
|
|
parameter file may collapsed. Therefore, the parameters file should be
|
||
|
|
discarded. If function succeeds, the return value is 1.
|
||
|
|
@param[out] prms A pointer to #AK8963PRMS structure. Member variables are
|
||
|
|
saved to the parameter file.
|
||
|
|
*/
|
||
|
|
int16 SaveParameters(AK8963PRMS * prms)
|
||
|
|
{
|
||
|
|
int16 ret = 1;
|
||
|
|
int16 i;
|
||
|
|
FILE *fp;
|
||
|
|
char keyName[64];
|
||
|
|
|
||
|
|
//Open setting file for write.
|
||
|
|
if ((fp = fopen(CSPEC_SETTING_FILE, "w")) == NULL) {
|
||
|
|
AKMERROR_STR("fopen");
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
for (i = 0; i < CSPEC_NUM_FORMATION; i++) {
|
||
|
|
snprintf(keyName, sizeof(keyName), "HSUC_HDST_FORM%d", i);
|
||
|
|
ret = ret && SaveInt16(fp, keyName, (int16)prms->HSUC_HDST[i]);
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "HSUC_HO_FORM%d", i);
|
||
|
|
ret = ret && SaveInt16vec(fp, keyName, &prms->HSUC_HO[i]);
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "HFLUCV_HREF_FORM%d", i);
|
||
|
|
ret = ret && SaveInt16vec(fp, keyName, &prms->HFLUCV_HREF[i]);
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "HSUC_HBASE_FORM%d", i);
|
||
|
|
ret = ret && SaveInt32vec(fp, keyName, &prms->HSUC_HBASE[i]);
|
||
|
|
}
|
||
|
|
|
||
|
|
if (fclose(fp) != 0) {
|
||
|
|
AKMERROR_STR("fclose");
|
||
|
|
ret = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (ret == 0) {
|
||
|
|
ALOGE("%s: failed.", __FUNCTION__);
|
||
|
|
}
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*!
|
||
|
|
Save parameters of int16 type structure to file. This function adds
|
||
|
|
@return If function fails, the return value is 0. When function fails,
|
||
|
|
parameter is not saved to file. If function succeeds, the return value is 1.
|
||
|
|
@param[in] fp Pointer to \c FILE structure.
|
||
|
|
@param[in] lpKeyName The name of paraemter.
|
||
|
|
@param[in] val Pointer to \c int16 type value.
|
||
|
|
*/
|
||
|
|
int16 SaveInt16(FILE * fp, const char *lpKeyName, const int16 val)
|
||
|
|
{
|
||
|
|
if (fprintf(fp, "%s" DELIMITER "%d\n", lpKeyName, val) < 0) {
|
||
|
|
ALOGE("%s: printf (%s) error.", __FUNCTION__, lpKeyName);
|
||
|
|
return 0;
|
||
|
|
} else {
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/*!
|
||
|
|
Save parameters of int16vec type structure to file. This function adds
|
||
|
|
".x", ".y" and ".z" to the last of parameter name and save value with
|
||
|
|
the combined name.
|
||
|
|
@return If function fails, the return value is 0. When function fails, not
|
||
|
|
all parameters are saved to file, i.e. parameters file may collapsed.
|
||
|
|
If function succeeds, the return value is 1.
|
||
|
|
@param[in] fp Pointer to \c FILE structure.
|
||
|
|
@param[in] lpKeyName The name of paraemter.
|
||
|
|
@param[in] vec Pointer to \c int16vec type structure.
|
||
|
|
*/
|
||
|
|
int16 SaveInt16vec(FILE * fp, const char *lpKeyName,
|
||
|
|
const int16vec * vec)
|
||
|
|
{
|
||
|
|
int16 ret = 0;
|
||
|
|
char keyName[64];
|
||
|
|
|
||
|
|
ret = 1;
|
||
|
|
snprintf(keyName, sizeof(keyName), "%s.x", lpKeyName);
|
||
|
|
ret = ret && SaveInt16(fp, keyName, vec->u.x);
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "%s.y", lpKeyName);
|
||
|
|
ret = ret && SaveInt16(fp, keyName, vec->u.y);
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "%s.z", lpKeyName);
|
||
|
|
ret = ret && SaveInt16(fp, keyName, vec->u.z);
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*!
|
||
|
|
Save parameters of int32 type structure to file. This function adds
|
||
|
|
@return If function fails, the return value is 0. When function fails,
|
||
|
|
parameter is not saved to file. If function succeeds, the return value is 1.
|
||
|
|
@param[in] fp Pointer to \c FILE structure.
|
||
|
|
@param[in] lpKeyName The name of paraemter.
|
||
|
|
@param[in] val Pointer to \c int32 type value.
|
||
|
|
*/
|
||
|
|
int16 SaveInt32(FILE * fp, const char *lpKeyName, const int32 val)
|
||
|
|
{
|
||
|
|
if (fprintf(fp, "%s" DELIMITER "%ld\n", lpKeyName, val) < 0) {
|
||
|
|
ALOGE("%s: printf (%s) error.", __FUNCTION__, lpKeyName);
|
||
|
|
return 0;
|
||
|
|
} else {
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/*!
|
||
|
|
Save parameters of int32vec type structure to file. This function adds
|
||
|
|
".x", ".y" and ".z" to the last of parameter name and save value with
|
||
|
|
the combined name.
|
||
|
|
@return If function fails, the return value is 0. When function fails, not
|
||
|
|
all parameters are saved to file, i.e. parameters file may collapsed.
|
||
|
|
If function succeeds, the return value is 1.
|
||
|
|
@param[in] fp Pointer to \c FILE structure.
|
||
|
|
@param[in] lpKeyName The name of paraemter.
|
||
|
|
@param[in] vec Pointer to \c int32vec type structure.
|
||
|
|
*/
|
||
|
|
int16 SaveInt32vec(FILE * fp, const char *lpKeyName,
|
||
|
|
const int32vec * vec)
|
||
|
|
{
|
||
|
|
int16 ret = 0;
|
||
|
|
char keyName[64];
|
||
|
|
|
||
|
|
ret = 1;
|
||
|
|
snprintf(keyName, sizeof(keyName), "%s.x", lpKeyName);
|
||
|
|
ret = ret && SaveInt32(fp, keyName, vec->u.x);
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "%s.y", lpKeyName);
|
||
|
|
ret = ret && SaveInt32(fp, keyName, vec->u.y);
|
||
|
|
|
||
|
|
snprintf(keyName, sizeof(keyName), "%s.z", lpKeyName);
|
||
|
|
ret = ret && SaveInt32(fp, keyName, vec->u.z);
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|