Rohm / KX022

KX022 Accelerometer library

Dependents:   LazuriteGraph_Hello KX022_Hello GR-PEACH_IoT_Platform_HTTP_sample

KX022.cpp@0:e642dd732c4b, 2015-12-30 (annotated)

Committer:
MACRUM
Date:
Wed Dec 30 16:16:32 2015 +0000
Revision:
0:e642dd732c4b
Child:
3:e2d1659fe67e
Initial commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
MACRUM 0:e642dd732c4b 1 /* Copyright (c) 2015 ARM Ltd., MIT License
MACRUM 0:e642dd732c4b 2 *
MACRUM 0:e642dd732c4b 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
MACRUM 0:e642dd732c4b 4 * and associated documentation files (the "Software"), to deal in the Software without
MACRUM 0:e642dd732c4b 5 * restriction, including without limitation the rights to use, copy, modify, merge, publish,
MACRUM 0:e642dd732c4b 6 * distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the
MACRUM 0:e642dd732c4b 7 * Software is furnished to do so, subject to the following conditions:
MACRUM 0:e642dd732c4b 8 *
MACRUM 0:e642dd732c4b 9 * The above copyright notice and this permission notice shall be included in all copies or
MACRUM 0:e642dd732c4b 10 * substantial portions of the Software.
MACRUM 0:e642dd732c4b 11 *
MACRUM 0:e642dd732c4b 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
MACRUM 0:e642dd732c4b 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
MACRUM 0:e642dd732c4b 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
MACRUM 0:e642dd732c4b 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
MACRUM 0:e642dd732c4b 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
MACRUM 0:e642dd732c4b 17 *
MACRUM 0:e642dd732c4b 18 *
MACRUM 0:e642dd732c4b 19 * KX022 Accelerometer library
MACRUM 0:e642dd732c4b 20 *
MACRUM 0:e642dd732c4b 21 * @author Toyomasa Watarai
MACRUM 0:e642dd732c4b 22 * @version 1.0
MACRUM 0:e642dd732c4b 23 * @date 30-December-2015
MACRUM 0:e642dd732c4b 24 *
MACRUM 0:e642dd732c4b 25 * Library for "KX022 Accelerometer library" from Kionix a Rohm group
MACRUM 0:e642dd732c4b 26 * http://www.kionix.com/product/KX022-1020
MACRUM 0:e642dd732c4b 27 *
MACRUM 0:e642dd732c4b 28 */
MACRUM 0:e642dd732c4b 29
MACRUM 0:e642dd732c4b 30 #include "mbed.h"
MACRUM 0:e642dd732c4b 31 #include "KX022.h"
MACRUM 0:e642dd732c4b 32
MACRUM 0:e642dd732c4b 33 KX022::KX022(PinName sda, PinName scl, int addr) : m_i2c(sda, scl), m_addr(addr)
MACRUM 0:e642dd732c4b 34 {
MACRUM 0:e642dd732c4b 35 initialize();
MACRUM 0:e642dd732c4b 36 }
MACRUM 0:e642dd732c4b 37
MACRUM 0:e642dd732c4b 38 KX022::KX022(I2C &i2c_obj, int addr) : m_i2c(i2c_obj), m_addr(addr)
MACRUM 0:e642dd732c4b 39 {
MACRUM 0:e642dd732c4b 40 initialize();
MACRUM 0:e642dd732c4b 41 }
MACRUM 0:e642dd732c4b 42
MACRUM 0:e642dd732c4b 43 KX022::~KX022()
MACRUM 0:e642dd732c4b 44 {
MACRUM 0:e642dd732c4b 45 }
MACRUM 0:e642dd732c4b 46
MACRUM 0:e642dd732c4b 47 void KX022::initialize()
MACRUM 0:e642dd732c4b 48 {
MACRUM 0:e642dd732c4b 49 unsigned char buf;
MACRUM 0:e642dd732c4b 50 unsigned char reg[2];
MACRUM 0:e642dd732c4b 51
MACRUM 0:e642dd732c4b 52 readRegs(KX022_WHO_AM_I, &buf, sizeof(buf));
MACRUM 0:e642dd732c4b 53 if (buf != KX022_WAI_VAL) {
MACRUM 0:e642dd732c4b 54 DEBUG_PRINT("KX022 initialization error. (%d)\n", buf);
MACRUM 0:e642dd732c4b 55 return;
MACRUM 0:e642dd732c4b 56 }
MACRUM 0:e642dd732c4b 57
MACRUM 0:e642dd732c4b 58 reg[0] = KX022_CNTL1;
MACRUM 0:e642dd732c4b 59 reg[1] = 0x41;
MACRUM 0:e642dd732c4b 60 writeRegs(reg, 2);
MACRUM 0:e642dd732c4b 61
MACRUM 0:e642dd732c4b 62 reg[0] = KX022_ODCNTL;
MACRUM 0:e642dd732c4b 63 reg[1] = 0x02;
MACRUM 0:e642dd732c4b 64 writeRegs(reg, 2);
MACRUM 0:e642dd732c4b 65
MACRUM 0:e642dd732c4b 66 reg[0] = KX022_CNTL3;
MACRUM 0:e642dd732c4b 67 reg[1] = 0xD8;
MACRUM 0:e642dd732c4b 68 writeRegs(reg, 2);
MACRUM 0:e642dd732c4b 69
MACRUM 0:e642dd732c4b 70 reg[0] = KX022_TILT_TIMER;
MACRUM 0:e642dd732c4b 71 reg[1] = 0x01;
MACRUM 0:e642dd732c4b 72 writeRegs(reg, 2);
MACRUM 0:e642dd732c4b 73
MACRUM 0:e642dd732c4b 74 reg[0] = KX022_CNTL1;
MACRUM 0:e642dd732c4b 75 reg[1] = 0xC1;
MACRUM 0:e642dd732c4b 76 writeRegs(reg, 2);
MACRUM 0:e642dd732c4b 77 }
MACRUM 0:e642dd732c4b 78
MACRUM 0:e642dd732c4b 79 float KX022::getAccX()
MACRUM 0:e642dd732c4b 80 {
MACRUM 0:e642dd732c4b 81 return (float(getAccAxis(KX022_XOUT_L))/16384);
MACRUM 0:e642dd732c4b 82 }
MACRUM 0:e642dd732c4b 83
MACRUM 0:e642dd732c4b 84 float KX022::getAccY()
MACRUM 0:e642dd732c4b 85 {
MACRUM 0:e642dd732c4b 86 return (float(getAccAxis(KX022_YOUT_L))/16384);
MACRUM 0:e642dd732c4b 87 }
MACRUM 0:e642dd732c4b 88
MACRUM 0:e642dd732c4b 89 float KX022::getAccZ()
MACRUM 0:e642dd732c4b 90 {
MACRUM 0:e642dd732c4b 91 return (float(getAccAxis(KX022_ZOUT_L))/16384);
MACRUM 0:e642dd732c4b 92 }
MACRUM 0:e642dd732c4b 93
MACRUM 0:e642dd732c4b 94 void KX022::getAccAllAxis(float * res)
MACRUM 0:e642dd732c4b 95 {
MACRUM 0:e642dd732c4b 96 res[0] = getAccX();
MACRUM 0:e642dd732c4b 97 res[1] = getAccY();
MACRUM 0:e642dd732c4b 98 res[2] = getAccZ();
MACRUM 0:e642dd732c4b 99 }
MACRUM 0:e642dd732c4b 100
MACRUM 0:e642dd732c4b 101 int16_t KX022::getAccAxis(uint8_t addr)
MACRUM 0:e642dd732c4b 102 {
MACRUM 0:e642dd732c4b 103 int16_t acc;
MACRUM 0:e642dd732c4b 104 uint8_t res[2];
MACRUM 0:e642dd732c4b 105
MACRUM 0:e642dd732c4b 106 readRegs(addr, res, 2);
MACRUM 0:e642dd732c4b 107 acc = ((res[1] << 8) | res[0]);
MACRUM 0:e642dd732c4b 108 return acc;
MACRUM 0:e642dd732c4b 109 }
MACRUM 0:e642dd732c4b 110
MACRUM 0:e642dd732c4b 111 void KX022::readRegs(int addr, uint8_t * data, int len)
MACRUM 0:e642dd732c4b 112 {
MACRUM 0:e642dd732c4b 113 char t[1] = {addr};
MACRUM 0:e642dd732c4b 114 m_i2c.write(m_addr, t, 1, true);
MACRUM 0:e642dd732c4b 115 m_i2c.read(m_addr, (char *)data, len);
MACRUM 0:e642dd732c4b 116 }
MACRUM 0:e642dd732c4b 117
MACRUM 0:e642dd732c4b 118 void KX022::writeRegs(uint8_t * data, int len)
MACRUM 0:e642dd732c4b 119 {
MACRUM 0:e642dd732c4b 120 m_i2c.write(m_addr, (char *)data, len);
MACRUM 0:e642dd732c4b 121 }