diff options
author | Wolfgang Wiedmeyer <wolfgit@wiedmeyer.de> | 2017-01-13 12:49:13 +0100 |
---|---|---|
committer | Wolfgang Wiedmeyer <wolfgit@wiedmeyer.de> | 2017-01-13 12:49:13 +0100 |
commit | 719298e8ec1a32ef72c7c3b34a29f6da5636e2e5 (patch) | |
tree | f28d674e216dc2f43b63141672dd994d7d800da8 /sensors/akmdfs/AKFS_APIs_8975/AKFS_VNorm.c | |
parent | 0db98a7f04011001327ca8dc80246861d6c178df (diff) | |
parent | ebc81b7fe79377a0011269bc1fd43c6def483b9d (diff) | |
download | device_samsung_i9100-719298e8ec1a32ef72c7c3b34a29f6da5636e2e5.zip device_samsung_i9100-719298e8ec1a32ef72c7c3b34a29f6da5636e2e5.tar.gz device_samsung_i9100-719298e8ec1a32ef72c7c3b34a29f6da5636e2e5.tar.bz2 |
Merge remote-tracking branch 'repliforge/i9100-devel' into replicant-6.0
Diffstat (limited to 'sensors/akmdfs/AKFS_APIs_8975/AKFS_VNorm.c')
-rw-r--r-- | sensors/akmdfs/AKFS_APIs_8975/AKFS_VNorm.c | 107 |
1 files changed, 107 insertions, 0 deletions
diff --git a/sensors/akmdfs/AKFS_APIs_8975/AKFS_VNorm.c b/sensors/akmdfs/AKFS_APIs_8975/AKFS_VNorm.c new file mode 100644 index 0000000..ffa934a --- /dev/null +++ b/sensors/akmdfs/AKFS_APIs_8975/AKFS_VNorm.c @@ -0,0 +1,107 @@ +/****************************************************************************** + * + * 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_VNorm.h" +#include "AKFS_Device.h" + +/*! + */ +int16 AKFS_VbNorm( + const int16 ndata, /*!< Size of raw vector buffer */ + const AKFVEC vdata[], /*!< Raw vector buffer */ + const int16 nbuf, /*!< Size of data to be buffered */ + const AKFVEC* o, /*!< Offset */ + const AKFVEC* s, /*!< Sensitivity */ + const AKFLOAT tgt, /*!< Target sensitivity */ + const int16 nvec, /*!< Size of normalized vector buffer */ + AKFVEC vvec[] /*!< Normalized vector buffer */ +) +{ + int i; + + /* size check */ + if ((ndata <= 0) || (nvec <= 0) || (nbuf <= 0)) { + return AKFS_ERROR; + } + /* dependency check */ + if ((nbuf < 1) || (ndata < nbuf) || (nvec < nbuf)) { + return AKFS_ERROR; + } + /* sensitivity check */ + if ((s->u.x <= AKFS_EPSILON) || + (s->u.y <= AKFS_EPSILON) || + (s->u.z <= AKFS_EPSILON) || + (tgt <= 0)) { + return AKFS_ERROR; + } + + /* calculate and store data to buffer */ + if (AKFS_BufShift(nvec, nbuf, vvec) != AKFS_SUCCESS) { + return AKFS_ERROR; + } + for (i=0; i<nbuf; i++) { + vvec[i].u.x = ((vdata[i].u.x - o->u.x) / (s->u.x) * (AKFLOAT)tgt); + vvec[i].u.y = ((vdata[i].u.y - o->u.y) / (s->u.y) * (AKFLOAT)tgt); + vvec[i].u.z = ((vdata[i].u.z - o->u.z) / (s->u.z) * (AKFLOAT)tgt); + } + + return AKFS_SUCCESS; +} + +/*! + */ +int16 AKFS_VbAve( + const int16 nvec, /*!< Size of normalized vector buffer */ + const AKFVEC vvec[], /*!< Normalized vector buffer */ + const int16 nave, /*!< Number of averaeg */ + AKFVEC* vave /*!< Averaged vector */ +) +{ + int i; + + /* arguments check */ + if ((nave <= 0) || (nvec <= 0) || (nvec < nave)) { + return AKFS_ERROR; + } + + /* calculate average */ + vave->u.x = 0; + vave->u.y = 0; + vave->u.z = 0; + for (i=0; i<nave; i++) { + if ((vvec[i].u.x == AKFS_INIT_VALUE_F) || + (vvec[i].u.y == AKFS_INIT_VALUE_F) || + (vvec[i].u.z == AKFS_INIT_VALUE_F)) { + break; + } + vave->u.x += vvec[i].u.x; + vave->u.y += vvec[i].u.y; + vave->u.z += vvec[i].u.z; + } + if (i == 0) { + vave->u.x = 0; + vave->u.y = 0; + vave->u.z = 0; + } else { + vave->u.x /= i; + vave->u.y /= i; + vave->u.z /= i; + } + return AKFS_SUCCESS; +} + + |