Danny Eldering / Mbed 2 deprecated KXTJ3

KX022 Accelerometer library

Dependencies:   mbed

Dependents:   SP_BEUNBOX_code

Fork of KX022 by Rohm

KXTJ3.cpp@5:9519f53d9965, 2019-02-05 (annotated)

Committer:
deldering95
Date:
Tue Feb 05 15:23:38 2019 +0000
Revision:
5:9519f53d9965
Parent:
4:4038b02c530d 
Changed Initialization code to check whether it is needed to initialize

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 *
deldering95 4:4038b02c530d 19 * KXTJ3 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 *
deldering95 4:4038b02c530d 25 * Library for "KXTJ3 Accelerometer library" from Kionix a Rohm group
deldering95 4:4038b02c530d 26 * http://www.kionix.com/product/KXTJ3-1020
MACRUM 0:e642dd732c4b 27 *
MACRUM 0:e642dd732c4b 28 */
MACRUM 0:e642dd732c4b 29
MACRUM 0:e642dd732c4b 30 #include "mbed.h"
deldering95 4:4038b02c530d 31 #include "KXTJ3.h"
MACRUM 0:e642dd732c4b 32
deldering95 4:4038b02c530d 33 //KXTJ3::KXTJ3(PinName sda, PinName scl, int addr) : m_i2c(sda, scl), m_addr(addr)
deldering95 4:4038b02c530d 34 //{
deldering95 4:4038b02c530d 35 // initialize();
deldering95 4:4038b02c530d 36 //}
MACRUM 0:e642dd732c4b 37
deldering95 4:4038b02c530d 38 KXTJ3::KXTJ3(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
deldering95 4:4038b02c530d 43 KXTJ3::~KXTJ3()
MACRUM 0:e642dd732c4b 44 {
MACRUM 0:e642dd732c4b 45 }
MACRUM 0:e642dd732c4b 46
deldering95 4:4038b02c530d 47 void KXTJ3::initialize()
MACRUM 0:e642dd732c4b 48 {
deldering95 4:4038b02c530d 49 // unsigned char buf;
MACRUM 0:e642dd732c4b 50 unsigned char reg[2];
deldering95 4:4038b02c530d 51 /*
deldering95 4:4038b02c530d 52 DEBUG_PRINT("KXTJ3 init started\n\r");
deldering95 4:4038b02c530d 53 readRegs(KXTJ3_WHO_AM_I, &buf, 1);
deldering95 4:4038b02c530d 54 if (buf != KXTJ3_WAI_VAL) {
deldering95 4:4038b02c530d 55 DEBUG_PRINT("KXTJ3 initialization error. (WAI %d, not %d)\n\r", buf, KXTJ3_WAI_VAL);
MikkoZ 3:e2d1659fe67e 56 DEBUG_PRINT("Trying to config anyway, in case there is some compatible sensor connected.\n\r");
MACRUM 0:e642dd732c4b 57 }
deldering95 4:4038b02c530d 58 */
deldering95 5:9519f53d9965 59
deldering95 5:9519f53d9965 60 readRegs(KXTJ3_CNTL1, reg, 1);
deldering95 5:9519f53d9965 61 if(reg[0]!=0xC0){
deldering95 5:9519f53d9965 62
deldering95 5:9519f53d9965 63 reg[0] = KXTJ3_CNTL1;
deldering95 5:9519f53d9965 64 reg[1] = 0x40;
deldering95 5:9519f53d9965 65 writeRegs(reg, 2);
MACRUM 0:e642dd732c4b 66
deldering95 5:9519f53d9965 67 reg[0] = KXTJ3_ODCNTL;
deldering95 5:9519f53d9965 68 reg[1] = 0x01;
deldering95 5:9519f53d9965 69 writeRegs(reg, 2);
MACRUM 0:e642dd732c4b 70
deldering95 5:9519f53d9965 71 reg[0] = KXTJ3_CNTL1;
deldering95 5:9519f53d9965 72 reg[1] = 0xC0;
deldering95 5:9519f53d9965 73 writeRegs(reg, 2);}
MACRUM 0:e642dd732c4b 74 }
MACRUM 0:e642dd732c4b 75
deldering95 4:4038b02c530d 76 float KXTJ3::getAccX()
MACRUM 0:e642dd732c4b 77 {
deldering95 4:4038b02c530d 78 return (float(getAccAxis(KXTJ3_XOUT_L))/16384);
MACRUM 0:e642dd732c4b 79 }
MACRUM 0:e642dd732c4b 80
deldering95 4:4038b02c530d 81 float KXTJ3::getAccY()
MACRUM 0:e642dd732c4b 82 {
deldering95 4:4038b02c530d 83 return (float(getAccAxis(KXTJ3_YOUT_L))/16384);
MACRUM 0:e642dd732c4b 84 }
MACRUM 0:e642dd732c4b 85
deldering95 4:4038b02c530d 86 float KXTJ3::getAccZ()
MACRUM 0:e642dd732c4b 87 {
deldering95 4:4038b02c530d 88 return (float(getAccAxis(KXTJ3_ZOUT_L))/16384);
MACRUM 0:e642dd732c4b 89 }
MACRUM 0:e642dd732c4b 90
deldering95 4:4038b02c530d 91 void KXTJ3::getAccAllAxis(float * res)
MACRUM 0:e642dd732c4b 92 {
MACRUM 0:e642dd732c4b 93 res[0] = getAccX();
MACRUM 0:e642dd732c4b 94 res[1] = getAccY();
MACRUM 0:e642dd732c4b 95 res[2] = getAccZ();
MACRUM 0:e642dd732c4b 96 }
MACRUM 0:e642dd732c4b 97
deldering95 4:4038b02c530d 98 int16_t KXTJ3::getAccAxis(uint8_t addr)
MACRUM 0:e642dd732c4b 99 {
MACRUM 0:e642dd732c4b 100 int16_t acc;
MACRUM 0:e642dd732c4b 101 uint8_t res[2];
MACRUM 0:e642dd732c4b 102
MACRUM 0:e642dd732c4b 103 readRegs(addr, res, 2);
MACRUM 0:e642dd732c4b 104 acc = ((res[1] << 8) | res[0]);
MACRUM 0:e642dd732c4b 105 return acc;
MACRUM 0:e642dd732c4b 106 }
MACRUM 0:e642dd732c4b 107
deldering95 4:4038b02c530d 108 void KXTJ3::readRegs(int addr, uint8_t * data, int len)
MACRUM 0:e642dd732c4b 109 {
MikkoZ 3:e2d1659fe67e 110 int read_nok;
MACRUM 0:e642dd732c4b 111 char t[1] = {addr};
MikkoZ 3:e2d1659fe67e 112
deldering95 4:4038b02c530d 113 m_i2c->write(m_addr, t, 1,true);
deldering95 4:4038b02c530d 114 read_nok = m_i2c->read(m_addr, (char *)data, len);
MikkoZ 3:e2d1659fe67e 115 if (read_nok){
MikkoZ 3:e2d1659fe67e 116 DEBUG_PRINT("Read fail\n\r");
MikkoZ 3:e2d1659fe67e 117 }
MACRUM 0:e642dd732c4b 118 }
MACRUM 0:e642dd732c4b 119
deldering95 4:4038b02c530d 120 void KXTJ3::writeRegs(uint8_t * data, int len)
MACRUM 0:e642dd732c4b 121 {
deldering95 4:4038b02c530d 122 m_i2c->write(m_addr, (char *)data, len);
MACRUM 0:e642dd732c4b 123 }