Jerry Bradshaw
/
mbed-os-test
ddd
HSP/Devices/LIS2DH/LIS2DH_RPC.cpp@0:e4a10ed6eb92, 2016-10-25 (annotated)
- Committer:
- jbradshaw
- Date:
- Tue Oct 25 15:22:11 2016 +0000
- Revision:
- 0:e4a10ed6eb92
tewt
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
jbradshaw | 0:e4a10ed6eb92 | 1 | /******************************************************************************* |
jbradshaw | 0:e4a10ed6eb92 | 2 | * Copyright (C) 2016 Maxim Integrated Products, Inc., All Rights Reserved. |
jbradshaw | 0:e4a10ed6eb92 | 3 | * |
jbradshaw | 0:e4a10ed6eb92 | 4 | * Permission is hereby granted, free of charge, to any person obtaining a |
jbradshaw | 0:e4a10ed6eb92 | 5 | * copy of this software and associated documentation files (the "Software"), |
jbradshaw | 0:e4a10ed6eb92 | 6 | * to deal in the Software without restriction, including without limitation |
jbradshaw | 0:e4a10ed6eb92 | 7 | * the rights to use, copy, modify, merge, publish, distribute, sublicense, |
jbradshaw | 0:e4a10ed6eb92 | 8 | * and/or sell copies of the Software, and to permit persons to whom the |
jbradshaw | 0:e4a10ed6eb92 | 9 | * Software is furnished to do so, subject to the following conditions: |
jbradshaw | 0:e4a10ed6eb92 | 10 | * |
jbradshaw | 0:e4a10ed6eb92 | 11 | * The above copyright notice and this permission notice shall be included |
jbradshaw | 0:e4a10ed6eb92 | 12 | * in all copies or substantial portions of the Software. |
jbradshaw | 0:e4a10ed6eb92 | 13 | * |
jbradshaw | 0:e4a10ed6eb92 | 14 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS |
jbradshaw | 0:e4a10ed6eb92 | 15 | * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
jbradshaw | 0:e4a10ed6eb92 | 16 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. |
jbradshaw | 0:e4a10ed6eb92 | 17 | * IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES |
jbradshaw | 0:e4a10ed6eb92 | 18 | * OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, |
jbradshaw | 0:e4a10ed6eb92 | 19 | * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR |
jbradshaw | 0:e4a10ed6eb92 | 20 | * OTHER DEALINGS IN THE SOFTWARE. |
jbradshaw | 0:e4a10ed6eb92 | 21 | * |
jbradshaw | 0:e4a10ed6eb92 | 22 | * Except as contained in this notice, the name of Maxim Integrated |
jbradshaw | 0:e4a10ed6eb92 | 23 | * Products, Inc. shall not be used except as stated in the Maxim Integrated |
jbradshaw | 0:e4a10ed6eb92 | 24 | * Products, Inc. Branding Policy. |
jbradshaw | 0:e4a10ed6eb92 | 25 | * |
jbradshaw | 0:e4a10ed6eb92 | 26 | * The mere transfer of this software does not imply any licenses |
jbradshaw | 0:e4a10ed6eb92 | 27 | * of trade secrets, proprietary technology, copyrights, patents, |
jbradshaw | 0:e4a10ed6eb92 | 28 | * trademarks, maskwork rights, or any other form of intellectual |
jbradshaw | 0:e4a10ed6eb92 | 29 | * property whatsoever. Maxim Integrated Products, Inc. retains all |
jbradshaw | 0:e4a10ed6eb92 | 30 | * ownership rights. |
jbradshaw | 0:e4a10ed6eb92 | 31 | ******************************************************************************* |
jbradshaw | 0:e4a10ed6eb92 | 32 | */ |
jbradshaw | 0:e4a10ed6eb92 | 33 | |
jbradshaw | 0:e4a10ed6eb92 | 34 | #include "mbed.h" |
jbradshaw | 0:e4a10ed6eb92 | 35 | #include "LIS2DH.h" |
jbradshaw | 0:e4a10ed6eb92 | 36 | #include "StringInOut.h" |
jbradshaw | 0:e4a10ed6eb92 | 37 | #include "StringHelper.h" |
jbradshaw | 0:e4a10ed6eb92 | 38 | #include "Peripherals.h" |
jbradshaw | 0:e4a10ed6eb92 | 39 | |
jbradshaw | 0:e4a10ed6eb92 | 40 | #define LIS2DH_SLAVE_ADDRESS 0x32 |
jbradshaw | 0:e4a10ed6eb92 | 41 | #define LIS2DH_REG_PART_ID 0x0F |
jbradshaw | 0:e4a10ed6eb92 | 42 | |
jbradshaw | 0:e4a10ed6eb92 | 43 | //****************************************************************************** |
jbradshaw | 0:e4a10ed6eb92 | 44 | int LIS2DH_ReadReg(char argStrs[32][32], char replyStrs[32][32]) { |
jbradshaw | 0:e4a10ed6eb92 | 45 | uint8_t args[1]; |
jbradshaw | 0:e4a10ed6eb92 | 46 | uint8_t reply[1]; |
jbradshaw | 0:e4a10ed6eb92 | 47 | ProcessArgs(argStrs, args, sizeof(args)); |
jbradshaw | 0:e4a10ed6eb92 | 48 | LIS2DH *lis2dh = Peripherals::lis2dh(); |
jbradshaw | 0:e4a10ed6eb92 | 49 | lis2dh->readReg(args[0], (char *)reply); |
jbradshaw | 0:e4a10ed6eb92 | 50 | FormatReply(reply, sizeof(reply), replyStrs); |
jbradshaw | 0:e4a10ed6eb92 | 51 | return 0; |
jbradshaw | 0:e4a10ed6eb92 | 52 | } |
jbradshaw | 0:e4a10ed6eb92 | 53 | |
jbradshaw | 0:e4a10ed6eb92 | 54 | //****************************************************************************** |
jbradshaw | 0:e4a10ed6eb92 | 55 | int LIS2DH_WriteReg(char argStrs[32][32], char replyStrs[32][32]) { |
jbradshaw | 0:e4a10ed6eb92 | 56 | uint8_t args[2]; |
jbradshaw | 0:e4a10ed6eb92 | 57 | uint8_t reply[1]; |
jbradshaw | 0:e4a10ed6eb92 | 58 | ProcessArgs(argStrs, args, sizeof(args)); |
jbradshaw | 0:e4a10ed6eb92 | 59 | LIS2DH *lis2dh = Peripherals::lis2dh(); |
jbradshaw | 0:e4a10ed6eb92 | 60 | lis2dh->writeReg(args[0], args[1]); // pass in the register address |
jbradshaw | 0:e4a10ed6eb92 | 61 | reply[0] = 0x80; |
jbradshaw | 0:e4a10ed6eb92 | 62 | FormatReply(reply, sizeof(reply), replyStrs); |
jbradshaw | 0:e4a10ed6eb92 | 63 | return 0; |
jbradshaw | 0:e4a10ed6eb92 | 64 | } |
jbradshaw | 0:e4a10ed6eb92 | 65 | |
jbradshaw | 0:e4a10ed6eb92 | 66 | extern int highDataRate; |
jbradshaw | 0:e4a10ed6eb92 | 67 | //****************************************************************************** |
jbradshaw | 0:e4a10ed6eb92 | 68 | int LIS2DH_InitStart(char argStrs[32][32], char replyStrs[32][32]) { |
jbradshaw | 0:e4a10ed6eb92 | 69 | uint8_t args[2]; |
jbradshaw | 0:e4a10ed6eb92 | 70 | uint8_t reply[1]; |
jbradshaw | 0:e4a10ed6eb92 | 71 | ProcessArgs(argStrs, args, sizeof(args)); |
jbradshaw | 0:e4a10ed6eb92 | 72 | LIS2DH *lis2dh = Peripherals::lis2dh(); |
jbradshaw | 0:e4a10ed6eb92 | 73 | if (args[0] >= LIS2DH_DATARATE_200HZ) |
jbradshaw | 0:e4a10ed6eb92 | 74 | highDataRate = 1; |
jbradshaw | 0:e4a10ed6eb92 | 75 | lis2dh->initStart(args[0], args[1]); |
jbradshaw | 0:e4a10ed6eb92 | 76 | reply[0] = 0x80; |
jbradshaw | 0:e4a10ed6eb92 | 77 | FormatReply(reply, sizeof(reply), replyStrs); |
jbradshaw | 0:e4a10ed6eb92 | 78 | return 0; |
jbradshaw | 0:e4a10ed6eb92 | 79 | } |
jbradshaw | 0:e4a10ed6eb92 | 80 | |
jbradshaw | 0:e4a10ed6eb92 | 81 | //****************************************************************************** |
jbradshaw | 0:e4a10ed6eb92 | 82 | int LIS2DH_Stop(char argStrs[32][32], char replyStrs[32][32]) { |
jbradshaw | 0:e4a10ed6eb92 | 83 | uint8_t reply[1]; |
jbradshaw | 0:e4a10ed6eb92 | 84 | LIS2DH *lis2dh = Peripherals::lis2dh(); |
jbradshaw | 0:e4a10ed6eb92 | 85 | lis2dh->stop(); |
jbradshaw | 0:e4a10ed6eb92 | 86 | reply[0] = 0x80; |
jbradshaw | 0:e4a10ed6eb92 | 87 | FormatReply(reply, sizeof(reply), replyStrs); |
jbradshaw | 0:e4a10ed6eb92 | 88 | return 0; |
jbradshaw | 0:e4a10ed6eb92 | 89 | } |