SMDK4210 Sensors

Cherry-picked!
Conflict: "initial L bringup" changes sensor API, follow suit.
Conflict: libsensors changes, doesn't matter, just delete it.

1 files changed, 130 insertions, 0 deletions

diff --git a/sensors/akmdfs/AKFS_FileIO.c b/sensors/akmdfs/AKFS_FileIO.c
new file mode 100644
index 0000000..92c2ce9
--- /dev/null
+++ b/sensors/akmdfs/AKFS_FileIO.c
@@ -0,0 +1,130 @@
+/******************************************************************************
+ *
+ * Copyright (C) 2012 Asahi Kasei Microdevices Corporation, Japan
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *      http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ *
+ ******************************************************************************/
+#include "AKFS_FileIO.h"
+
+/*** Constant definition ******************************************************/
+#ifdef AKFS_PRECISION_DOUBLE
+#define AKFS_SCANF_FORMAT	"%63s = %lf"
+#else
+#define AKFS_SCANF_FORMAT	"%63s = %f"
+#endif
+#define AKFS_PRINTF_FORMAT	"%s = %f\n"
+#define LOAD_BUF_SIZE	64
+
+/*!
+ Load parameters from file which is specified with #path.  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 #AKM_FAIL. 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 #AKM_SUCCESS.
+ @param[out] prms A pointer to #AK8975PRMS structure. Loaded parameter is
+  stored to the member of this structure.
+ @param[in] path A path to the setting file.
+ */
+int16 AKFS_LoadParameters(AK8975PRMS * prms, const char* path)
+{
+	int16 ret;
+	char buf[LOAD_BUF_SIZE];
+	FILE *fp = NULL;
+
+	/* Open setting file for read. */
+	if ((fp = fopen(path, "r")) == NULL) {
+		AKMERROR_STR("fopen");
+		return AKM_FAIL;
+	}
+
+	ret = 1;
+
+	/* Load data to HO */
+	if (fscanf(fp, AKFS_SCANF_FORMAT, buf, &prms->mfv_ho.u.x) != 2) {
+		ret = 0;
+	} else {
+		if (strncmp(buf, "HO.x", sizeof(buf)) != 0) {
+			ret = 0;
+		}
+	}
+	if (fscanf(fp, AKFS_SCANF_FORMAT, buf, &prms->mfv_ho.u.y) != 2) {
+		ret = 0;
+	} else {
+		if (strncmp(buf, "HO.y", sizeof(buf)) != 0) {
+			ret = 0;
+		}
+	}
+	if (fscanf(fp, AKFS_SCANF_FORMAT, buf, &prms->mfv_ho.u.z) != 2) {
+		ret = 0;
+	} else {
+		if (strncmp(buf, "HO.z", sizeof(buf)) != 0) {
+			ret = 0;
+		}
+	}
+
+	if (fclose(fp) != 0) {
+		AKMERROR_STR("fclose");
+		ret = 0;
+	}
+
+	if (ret == 0) {
+		AKMERROR;
+		return AKM_FAIL;
+	}
+
+	return AKM_SUCCESS;
+}
+
+/*!
+ Save parameters to file which is specified with #path. This function saves 
+  variables when the offsets of magnetic sensor estimated successfully.
+ @return If function fails, the return value is #AKM_FAIL. When function fails,
+  the parameter file may collapsed. Therefore, the parameters file should be
+  discarded. If function succeeds, the return value is #AKM_SUCCESS.
+ @param[out] prms A pointer to #AK8975PRMS structure. Member variables are
+  saved to the parameter file.
+ @param[in] path A path to the setting file.
+ */
+int16 AKFS_SaveParameters(AK8975PRMS *prms, const char* path)
+{
+	int16 ret = 1;
+	FILE *fp;
+
+	/*Open setting file for write. */
+	if ((fp = fopen(path, "w")) == NULL) {
+		AKMERROR_STR("fopen");
+		return AKM_FAIL;
+	}
+
+	/* Save data to HO */
+	if (fprintf(fp, AKFS_PRINTF_FORMAT, "HO.x", prms->mfv_ho.u.x) < 0) { ret = 0; }
+	if (fprintf(fp, AKFS_PRINTF_FORMAT, "HO.y", prms->mfv_ho.u.y) < 0) { ret = 0; }
+	if (fprintf(fp, AKFS_PRINTF_FORMAT, "HO.z", prms->mfv_ho.u.z) < 0) { ret = 0; }
+
+	if (fclose(fp) != 0) {
+		AKMERROR_STR("fclose");
+		ret = 0;
+	}
+
+	if (ret == 0) {
+		AKMERROR;
+		return AKM_FAIL;
+	}
+
+	return AKM_SUCCESS;
+}
+