Working on readReg
Fork of MPL3115A2 by
MPL3115.cpp@3:641510862795, 2018-02-27 (annotated)
- Committer:
- csinders
- Date:
- Tue Feb 27 15:56:28 2018 +0000
- Revision:
- 3:641510862795
- Parent:
- 2:c705222de18d
Have a start for readReg. Need to figure out the bitshifting for it.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
AswinSivakumar | 2:c705222de18d | 1 | /* |
AswinSivakumar | 2:c705222de18d | 2 | * Copyright (c) 2015 - 2016, Freescale Semiconductor, Inc. |
AswinSivakumar | 2:c705222de18d | 3 | * Copyright 2016-2017 NXP |
AswinSivakumar | 2:c705222de18d | 4 | * |
AswinSivakumar | 2:c705222de18d | 5 | * Redistribution and use in source and binary forms, with or without modification, |
AswinSivakumar | 2:c705222de18d | 6 | * are permitted provided that the following conditions are met: |
AswinSivakumar | 2:c705222de18d | 7 | * |
AswinSivakumar | 2:c705222de18d | 8 | * o Redistributions of source code must retain the above copyright notice, this list |
AswinSivakumar | 2:c705222de18d | 9 | * of conditions and the following disclaimer. |
AswinSivakumar | 2:c705222de18d | 10 | * |
AswinSivakumar | 2:c705222de18d | 11 | * o Redistributions in binary form must reproduce the above copyright notice, this |
AswinSivakumar | 2:c705222de18d | 12 | * list of conditions and the following disclaimer in the documentation and/or |
AswinSivakumar | 2:c705222de18d | 13 | * other materials provided with the distribution. |
AswinSivakumar | 2:c705222de18d | 14 | * |
AswinSivakumar | 2:c705222de18d | 15 | * o Neither the name of the copyright holder nor the names of its |
AswinSivakumar | 2:c705222de18d | 16 | * contributors may be used to endorse or promote products derived from this |
AswinSivakumar | 2:c705222de18d | 17 | * software without specific prior written permission. |
AswinSivakumar | 2:c705222de18d | 18 | * |
AswinSivakumar | 2:c705222de18d | 19 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND |
AswinSivakumar | 2:c705222de18d | 20 | * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
AswinSivakumar | 2:c705222de18d | 21 | * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
AswinSivakumar | 2:c705222de18d | 22 | * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR |
AswinSivakumar | 2:c705222de18d | 23 | * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES |
AswinSivakumar | 2:c705222de18d | 24 | * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
AswinSivakumar | 2:c705222de18d | 25 | * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON |
AswinSivakumar | 2:c705222de18d | 26 | * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
AswinSivakumar | 2:c705222de18d | 27 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
AswinSivakumar | 2:c705222de18d | 28 | * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
AswinSivakumar | 2:c705222de18d | 29 | */ |
AswinSivakumar | 0:2cc0f6ef330f | 30 | |
AswinSivakumar | 0:2cc0f6ef330f | 31 | #include "MPL3115.h" |
AswinSivakumar | 0:2cc0f6ef330f | 32 | #include "mbed.h" |
AswinSivakumar | 0:2cc0f6ef330f | 33 | |
AswinSivakumar | 0:2cc0f6ef330f | 34 | MPL3115::MPL3115(PinName sda, PinName scl) : MPL3115_i2c(sda,scl) |
AswinSivakumar | 0:2cc0f6ef330f | 35 | { |
AswinSivakumar | 0:2cc0f6ef330f | 36 | |
AswinSivakumar | 0:2cc0f6ef330f | 37 | } |
AswinSivakumar | 0:2cc0f6ef330f | 38 | |
AswinSivakumar | 0:2cc0f6ef330f | 39 | void MPL3115::MPL3115_config(void) |
AswinSivakumar | 0:2cc0f6ef330f | 40 | { |
AswinSivakumar | 0:2cc0f6ef330f | 41 | char d[2]; |
AswinSivakumar | 0:2cc0f6ef330f | 42 | d[0] = MPL3115_CTRL_REG1; //Puts device in Standby mode |
AswinSivakumar | 0:2cc0f6ef330f | 43 | d[1] = 0x00; |
AswinSivakumar | 0:2cc0f6ef330f | 44 | MPL3115_i2c.write(MPL3115_I2C_ADDRESS, d,2); |
AswinSivakumar | 0:2cc0f6ef330f | 45 | |
AswinSivakumar | 0:2cc0f6ef330f | 46 | |
AswinSivakumar | 0:2cc0f6ef330f | 47 | d[0] = MPL3115_CTRL_REG1; //Puts device in Active mode and in altimeter mode |
AswinSivakumar | 0:2cc0f6ef330f | 48 | d[1] = 0x81; |
AswinSivakumar | 0:2cc0f6ef330f | 49 | MPL3115_i2c.write(MPL3115_I2C_ADDRESS, d, 2); |
AswinSivakumar | 0:2cc0f6ef330f | 50 | |
AswinSivakumar | 0:2cc0f6ef330f | 51 | } |
AswinSivakumar | 0:2cc0f6ef330f | 52 | |
csinders | 3:641510862795 | 53 | int MPL3115::readReg(int address) { |
csinders | 3:641510862795 | 54 | int length = 8; |
csinders | 3:641510862795 | 55 | char d[1]; |
csinders | 3:641510862795 | 56 | char readData[length]; |
csinders | 3:641510862795 | 57 | |
csinders | 3:641510862795 | 58 | d[0] = MPL3115_STATUS; |
csinders | 3:641510862795 | 59 | MPL3115_i2c.write(MPL3115_I2C_ADDRESS,d,1,true); |
csinders | 3:641510862795 | 60 | MPL3115_i2c.read(MPL3115_I2C_ADDRESS,readData,length); |
csinders | 3:641510862795 | 61 | for (int i = 0; i < length; i++) { |
csinders | 3:641510862795 | 62 | if (readData[i]) { |
csinders | 3:641510862795 | 63 | printf("The readData of %d is 1\r\n",i); |
csinders | 3:641510862795 | 64 | } else { |
csinders | 3:641510862795 | 65 | printf("The readData of %d is 0\r\n",i); |
csinders | 3:641510862795 | 66 | } |
csinders | 3:641510862795 | 67 | } |
csinders | 3:641510862795 | 68 | |
csinders | 3:641510862795 | 69 | //printf("The readData is : %s\r\n", readData); |
csinders | 3:641510862795 | 70 | int returnValue = 0; |
csinders | 3:641510862795 | 71 | for (int i = 0; i < length; i++) { |
csinders | 3:641510862795 | 72 | returnValue << readData[i]; |
csinders | 3:641510862795 | 73 | } |
csinders | 3:641510862795 | 74 | |
csinders | 3:641510862795 | 75 | return returnValue; |
csinders | 3:641510862795 | 76 | |
csinders | 3:641510862795 | 77 | } |
AswinSivakumar | 0:2cc0f6ef330f | 78 | |
csinders | 3:641510862795 | 79 | |
AswinSivakumar | 0:2cc0f6ef330f | 80 | |
AswinSivakumar | 0:2cc0f6ef330f | 81 | void MPL3115::acquire_MPL3115_data_Altitude_in_m(float * alt_data) |
AswinSivakumar | 0:2cc0f6ef330f | 82 | { |
AswinSivakumar | 0:2cc0f6ef330f | 83 | |
AswinSivakumar | 0:2cc0f6ef330f | 84 | char data_bytes[7]; |
AswinSivakumar | 0:2cc0f6ef330f | 85 | char d[1]; |
AswinSivakumar | 0:2cc0f6ef330f | 86 | d[0]=MPL3115_STATUS; |
AswinSivakumar | 0:2cc0f6ef330f | 87 | MPL3115_i2c.write(MPL3115_I2C_ADDRESS,d,1,true); // Read the 6 data bytes - LSB and MSB for X, Y and Z Axes. |
AswinSivakumar | 0:2cc0f6ef330f | 88 | MPL3115_i2c.read(MPL3115_I2C_ADDRESS,data_bytes,5); |
AswinSivakumar | 0:2cc0f6ef330f | 89 | alt_data[0]= (float)((short)((data_bytes[1] << 8 ) | data_bytes[2])) + (float)(data_bytes[3]>>4) * 0.0625; |
AswinSivakumar | 0:2cc0f6ef330f | 90 | |
AswinSivakumar | 0:2cc0f6ef330f | 91 | |
AswinSivakumar | 0:2cc0f6ef330f | 92 | } |