i9300: add opensource sensors hal

Change-Id: Ia104c31f165fcaca1ee5dc471f7d71ca9abd387f

1 files changed, 110 insertions, 0 deletions

diff --git a/libsensors/akmdfs/AKFS_APIs_8975/AKFS_Device.c b/libsensors/akmdfs/AKFS_APIs_8975/AKFS_Device.c
new file mode 100644
index 0000000..3d99ab1
--- /dev/null
+++ b/libsensors/akmdfs/AKFS_APIs_8975/AKFS_Device.c
@@ -0,0 +1,110 @@
+/******************************************************************************
+ *
+ * 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_Device.h"
+
+int16 AKFS_InitBuffer(
+	const	int16	ndata,		/*!< Size of vector buffer */
+			AKFVEC	vdata[]		/*!< Vector buffer */
+)
+{
+	int i;
+
+	/* size check */
+	if (ndata <= 0) {
+		return AKFS_ERROR;
+	}
+
+	for (i=0; i<ndata; i++) {
+		vdata[i].u.x = AKFS_INIT_VALUE_F;
+		vdata[i].u.y = AKFS_INIT_VALUE_F;
+		vdata[i].u.z = AKFS_INIT_VALUE_F;
+	}
+
+	return AKFS_SUCCESS;
+}
+
+int16 AKFS_BufShift(
+	const	int16	len,	/*!< size of buffer */
+	const	int16	shift,	/*!< shift size */
+			AKFVEC	v[] /*!< buffer */
+)
+{
+	int16 i;
+
+	if((shift < 1) || (len < shift)) {
+		return AKFS_ERROR;
+	}
+	for (i = len-1; i >= shift; i--) {
+		v[i] = v[i-shift];
+	}
+	return AKFS_SUCCESS;
+}
+
+int16 AKFS_Rotate(
+	const	AKFS_PATNO	pat,
+			AKFVEC*		vec
+)
+{
+	AKFLOAT tmp;
+	switch(pat){
+		/* Obverse */
+		case PAT1:
+			/* This is Android default */
+			break;
+		case PAT2:
+			tmp = vec->u.x;
+			vec->u.x = vec->u.y;
+			vec->u.y = -tmp;
+			break;
+		case PAT3:
+			vec->u.x = -(vec->u.x);
+			vec->u.y = -(vec->u.y);
+			break;
+		case PAT4:
+			tmp = vec->u.x;
+			vec->u.x = -(vec->u.y);
+			vec->u.y = tmp;
+			break;
+		/* Reverse */
+		case PAT5:
+			vec->u.x = -(vec->u.x);
+			vec->u.z = -(vec->u.z);
+			break;
+		case PAT6:
+			tmp = vec->u.x;
+			vec->u.x = vec->u.y;
+			vec->u.y = tmp;
+			vec->u.z = -(vec->u.z);
+			break;
+		case PAT7:
+			vec->u.y = -(vec->u.y);
+			vec->u.z = -(vec->u.z);
+			break;
+		case PAT8:
+			tmp = vec->u.x;
+			vec->u.x = -(vec->u.y);
+			vec->u.y = -tmp;
+			vec->u.z = -(vec->u.z);
+			break;
+		default:
+			return AKFS_ERROR;
+	}
+
+	return AKFS_SUCCESS;
+}
+