diff options
author | Paul Kocialkowski <contact@paulk.fr> | 2013-12-28 14:10:40 +0100 |
---|---|---|
committer | Wolfgang Wiedmeyer <wolfgit@wiedmeyer.de> | 2017-06-07 00:37:42 +0200 |
commit | b2105ed1d5afdb12e03aac0f0898d778346f9e5c (patch) | |
tree | 1f5d153834f9c398340417c95ef9fc406734b65d /sensors/akmdfs/AKFS_APIs_8975/AKFS_Device.c | |
parent | 6ee4785334cc25c4e11ea4b28cb3dd3292609a4c (diff) | |
download | device_samsung_n7000-b2105ed1d5afdb12e03aac0f0898d778346f9e5c.zip device_samsung_n7000-b2105ed1d5afdb12e03aac0f0898d778346f9e5c.tar.gz device_samsung_n7000-b2105ed1d5afdb12e03aac0f0898d778346f9e5c.tar.bz2 |
SMDK4210 Sensors
Signed-off-by: Paul Kocialkowski <contact@paulk.fr>
Diffstat (limited to 'sensors/akmdfs/AKFS_APIs_8975/AKFS_Device.c')
-rw-r--r-- | sensors/akmdfs/AKFS_APIs_8975/AKFS_Device.c | 110 |
1 files changed, 110 insertions, 0 deletions
diff --git a/sensors/akmdfs/AKFS_APIs_8975/AKFS_Device.c b/sensors/akmdfs/AKFS_APIs_8975/AKFS_Device.c new file mode 100644 index 0000000..3d99ab1 --- /dev/null +++ b/sensors/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; +} + |