KX022 Accelerometer library
Dependents: LazuriteGraph_Hello KX022_Hello GR-PEACH_IoT_Platform_HTTP_sample
Diff: KX022.cpp
- Revision:
- 0:e642dd732c4b
- Child:
- 3:e2d1659fe67e
diff -r 000000000000 -r e642dd732c4b KX022.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/KX022.cpp Wed Dec 30 16:16:32 2015 +0000 @@ -0,0 +1,121 @@ +/* Copyright (c) 2015 ARM Ltd., MIT License +* +* Permission is hereby granted, free of charge, to any person obtaining a copy of this software +* and associated documentation files (the "Software"), to deal in the Software without +* restriction, including without limitation the rights to use, copy, modify, merge, publish, +* distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the +* Software is furnished to do so, subject to the following conditions: +* +* The above copyright notice and this permission notice shall be included in all copies or +* substantial portions of the Software. +* +* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING +* BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND +* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, +* DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, +* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. +* +* +* KX022 Accelerometer library +* +* @author Toyomasa Watarai +* @version 1.0 +* @date 30-December-2015 +* +* Library for "KX022 Accelerometer library" from Kionix a Rohm group +* http://www.kionix.com/product/KX022-1020 +* +*/ + +#include "mbed.h" +#include "KX022.h" + +KX022::KX022(PinName sda, PinName scl, int addr) : m_i2c(sda, scl), m_addr(addr) +{ + initialize(); +} + +KX022::KX022(I2C &i2c_obj, int addr) : m_i2c(i2c_obj), m_addr(addr) +{ + initialize(); +} + +KX022::~KX022() +{ +} + +void KX022::initialize() +{ + unsigned char buf; + unsigned char reg[2]; + + readRegs(KX022_WHO_AM_I, &buf, sizeof(buf)); + if (buf != KX022_WAI_VAL) { + DEBUG_PRINT("KX022 initialization error. (%d)\n", buf); + return; + } + + reg[0] = KX022_CNTL1; + reg[1] = 0x41; + writeRegs(reg, 2); + + reg[0] = KX022_ODCNTL; + reg[1] = 0x02; + writeRegs(reg, 2); + + reg[0] = KX022_CNTL3; + reg[1] = 0xD8; + writeRegs(reg, 2); + + reg[0] = KX022_TILT_TIMER; + reg[1] = 0x01; + writeRegs(reg, 2); + + reg[0] = KX022_CNTL1; + reg[1] = 0xC1; + writeRegs(reg, 2); +} + +float KX022::getAccX() +{ + return (float(getAccAxis(KX022_XOUT_L))/16384); +} + +float KX022::getAccY() +{ + return (float(getAccAxis(KX022_YOUT_L))/16384); +} + +float KX022::getAccZ() +{ + return (float(getAccAxis(KX022_ZOUT_L))/16384); +} + +void KX022::getAccAllAxis(float * res) +{ + res[0] = getAccX(); + res[1] = getAccY(); + res[2] = getAccZ(); +} + +int16_t KX022::getAccAxis(uint8_t addr) +{ + int16_t acc; + uint8_t res[2]; + + readRegs(addr, res, 2); + acc = ((res[1] << 8) | res[0]); + return acc; +} + +void KX022::readRegs(int addr, uint8_t * data, int len) +{ + char t[1] = {addr}; + m_i2c.write(m_addr, t, 1, true); + m_i2c.read(m_addr, (char *)data, len); +} + +void KX022::writeRegs(uint8_t * data, int len) +{ + m_i2c.write(m_addr, (char *)data, len); +}