Denwis La
/
mDot_Send_Data
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: libmDot-dev-mbed5-deprecated ISL29011
Fork of
mdot-examples
by 
3mdeb
peer_to_peer_example.cpp@4:b0ce6385d008, 2017-12-01 (annotated)
- Committer:
- SDesign2018
- Date:
- Fri Dec 01 01:07:57 2017 +0000
- Revision:
- 4:b0ce6385d008
- Child:
- 5:c9ab5062cfc3
Added a whole lot of comments
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| SDesign2018 | 4:b0ce6385d008 | 1 | #include "dot_util.h" |
| SDesign2018 | 4:b0ce6385d008 | 2 | #include "RadioEvent.h" |
| SDesign2018 | 4:b0ce6385d008 | 3 | #include <string.h> |
| SDesign2018 | 4:b0ce6385d008 | 4 | #include <mbed.h> |
| SDesign2018 | 4:b0ce6385d008 | 5 | |
| SDesign2018 | 4:b0ce6385d008 | 6 | |
| SDesign2018 | 4:b0ce6385d008 | 7 | ///////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 8 | // -------------------- DOT LIBRARY REQUIRED ------------------------------// |
| SDesign2018 | 4:b0ce6385d008 | 9 | // * Because these example programs can be used for both mDot and xDot // |
| SDesign2018 | 4:b0ce6385d008 | 10 | // devices, the LoRa stack is not included. The libmDot library should // |
| SDesign2018 | 4:b0ce6385d008 | 11 | // be imported if building for mDot devices. The libxDot library // |
| SDesign2018 | 4:b0ce6385d008 | 12 | // should be imported if building for xDot devices. // |
| SDesign2018 | 4:b0ce6385d008 | 13 | // * https://developer.mbed.org/teams/MultiTech/code/libmDot-dev-mbed5/ // |
| SDesign2018 | 4:b0ce6385d008 | 14 | // * https://developer.mbed.org/teams/MultiTech/code/libmDot-mbed5/ // |
| SDesign2018 | 4:b0ce6385d008 | 15 | // * https://developer.mbed.org/teams/MultiTech/code/libxDot-dev-mbed5/ // |
| SDesign2018 | 4:b0ce6385d008 | 16 | // * https://developer.mbed.org/teams/MultiTech/code/libxDot-mbed5/ // |
| SDesign2018 | 4:b0ce6385d008 | 17 | ///////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 18 | |
| SDesign2018 | 4:b0ce6385d008 | 19 | ///////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 20 | // * these options must match between the two devices in // |
| SDesign2018 | 4:b0ce6385d008 | 21 | // order for communication to be successful |
| SDesign2018 | 4:b0ce6385d008 | 22 | //-------------------MDOT variables------------------------// |
| SDesign2018 | 4:b0ce6385d008 | 23 | ///////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 24 | static uint8_t network_address[] = { 0x00, 0x11, 0x22, 0x33 }; |
| SDesign2018 | 4:b0ce6385d008 | 25 | static uint8_t network_session_key[] = { 0x00, 0x11, 0x22, 0x33, 0x00, 0x11, 0x22, 0x33, 0x00, 0x11, 0x22, 0x33, 0x00, 0x11, 0x22, 0x33 }; |
| SDesign2018 | 4:b0ce6385d008 | 26 | static uint8_t data_session_key[] = { 0x33, 0x22, 0x11, 0x00, 0x33, 0x22, 0x11, 0x00, 0x33, 0x22, 0x11, 0x00, 0x33, 0x22, 0x11, 0x00 }; |
| SDesign2018 | 4:b0ce6385d008 | 27 | |
| SDesign2018 | 4:b0ce6385d008 | 28 | mDot* dot = NULL; |
| SDesign2018 | 4:b0ce6385d008 | 29 | lora::ChannelPlan* plan = NULL; |
| SDesign2018 | 4:b0ce6385d008 | 30 | //--------------End of MDOT variables-------------------// |
| SDesign2018 | 4:b0ce6385d008 | 31 | |
| SDesign2018 | 4:b0ce6385d008 | 32 | Serial pc(USBTX, USBRX); |
| SDesign2018 | 4:b0ce6385d008 | 33 | |
| SDesign2018 | 4:b0ce6385d008 | 34 | // ADXL372 Slave SPI |
| SDesign2018 | 4:b0ce6385d008 | 35 | DigitalOut MOSI(D11); |
| SDesign2018 | 4:b0ce6385d008 | 36 | DigitalIn MISO(D12); |
| SDesign2018 | 4:b0ce6385d008 | 37 | DigitalOut SPI_CLK(D13); |
| SDesign2018 | 4:b0ce6385d008 | 38 | DigitalOut SPI_CS(D10); |
| SDesign2018 | 4:b0ce6385d008 | 39 | //InterruptIn INT1(); |
| SDesign2018 | 4:b0ce6385d008 | 40 | //InterruptIn INT2(); |
| SDesign2018 | 4:b0ce6385d008 | 41 | DigitalOut CS(D10); // Used for CS chip select |
| SDesign2018 | 4:b0ce6385d008 | 42 | |
| SDesign2018 | 4:b0ce6385d008 | 43 | // ADXL372 Slave I2C |
| SDesign2018 | 4:b0ce6385d008 | 44 | I2C ADXL372(I2C_SDA, I2C_SCL); // (D14,D15) (MISO, CS) |
| SDesign2018 | 4:b0ce6385d008 | 45 | |
| SDesign2018 | 4:b0ce6385d008 | 46 | // ADT7410 Temperature |
| SDesign2018 | 4:b0ce6385d008 | 47 | I2C ADT7410(I2C_SDA, I2C_SCL); // Attempt at making I2C connection to slaves (D14,D15) |
| SDesign2018 | 4:b0ce6385d008 | 48 | InterruptIn ADT7410_Int(D2); // Allow this pin for ADT7410 Interrupt critical temperature notice |
| SDesign2018 | 4:b0ce6385d008 | 49 | |
| SDesign2018 | 4:b0ce6385d008 | 50 | // DS7505s Temperature |
| SDesign2018 | 4:b0ce6385d008 | 51 | I2C DS7505(I2C_SDA, I2C_SCL); // Attempt at making I2C connection to slaves (D14,D15) |
| SDesign2018 | 4:b0ce6385d008 | 52 | |
| SDesign2018 | 4:b0ce6385d008 | 53 | // Create reocurring interrupt function that could be used to periodically take temperatures |
| SDesign2018 | 4:b0ce6385d008 | 54 | // Not working right now due to some mutex initialize error |
| SDesign2018 | 4:b0ce6385d008 | 55 | // Suspect that it is due to it having be a RTOS task thing |
| SDesign2018 | 4:b0ce6385d008 | 56 | // Should probably go back to using an in processor timer interrupt instead of mbed |
| SDesign2018 | 4:b0ce6385d008 | 57 | Ticker interruptEverything; |
| SDesign2018 | 4:b0ce6385d008 | 58 | |
| SDesign2018 | 4:b0ce6385d008 | 59 | const int ADT7410_Address_7BIT = 0x49; // A0 set HIGH and A1 set LOW |
| SDesign2018 | 4:b0ce6385d008 | 60 | const int ADT7410_Address_8BIT = ADT7410_Address_7BIT << 1; // Shift 1 bit to left for R/~W bit, and basic I2C format |
| SDesign2018 | 4:b0ce6385d008 | 61 | |
| SDesign2018 | 4:b0ce6385d008 | 62 | const int ADXL372_Address_7bit = 0x1D; // Address for the I2C if MISO pulled low, 0x53 if pulled high |
| SDesign2018 | 4:b0ce6385d008 | 63 | const int ADXL372_Address_8bit = ADXL372_Address_7bit << 1; // Same |
| SDesign2018 | 4:b0ce6385d008 | 64 | |
| SDesign2018 | 4:b0ce6385d008 | 65 | const int DS7505s_Address_7bit = 0x48; // A0 set LOR, A1 set LOW, A2 set LOW |
| SDesign2018 | 4:b0ce6385d008 | 66 | const int DS7505s_Address_8bit = DS7505s_Address_7bit << 1; // Same |
| SDesign2018 | 4:b0ce6385d008 | 67 | |
| SDesign2018 | 4:b0ce6385d008 | 68 | |
| SDesign2018 | 4:b0ce6385d008 | 69 | //-------------------All prototype functions-----------------------// |
| SDesign2018 | 4:b0ce6385d008 | 70 | void ADXL372Initialize(void); |
| SDesign2018 | 4:b0ce6385d008 | 71 | |
| SDesign2018 | 4:b0ce6385d008 | 72 | int accelerometerI2CWrite(int hexAddress, int hexData); |
| SDesign2018 | 4:b0ce6385d008 | 73 | char * accelerometerI2CRead(int hexAddress); |
| SDesign2018 | 4:b0ce6385d008 | 74 | void ADXL372Reset(void); |
| SDesign2018 | 4:b0ce6385d008 | 75 | void BitBangSPIWrite(const unsigned char regAddr, const unsigned char regData); |
| SDesign2018 | 4:b0ce6385d008 | 76 | unsigned char BitBangSPIRead (const unsigned char regAddr); |
| SDesign2018 | 4:b0ce6385d008 | 77 | |
| SDesign2018 | 4:b0ce6385d008 | 78 | int ADT7410Write(unsigned char registerAddress, unsigned char data); |
| SDesign2018 | 4:b0ce6385d008 | 79 | char * ADT7410Read(int hex); |
| SDesign2018 | 4:b0ce6385d008 | 80 | |
| SDesign2018 | 4:b0ce6385d008 | 81 | int DS7505sWrite(unsigned char registerAddress, unsigned char data); |
| SDesign2018 | 4:b0ce6385d008 | 82 | char * DS7505sRead(int hex); |
| SDesign2018 | 4:b0ce6385d008 | 83 | |
| SDesign2018 | 4:b0ce6385d008 | 84 | unsigned char * twosComplementConversion(unsigned char *value); |
| SDesign2018 | 4:b0ce6385d008 | 85 | //---------------------End of prototype functions-----------------------------// |
| SDesign2018 | 4:b0ce6385d008 | 86 | |
| SDesign2018 | 4:b0ce6385d008 | 87 | void printMenu(){ |
| SDesign2018 | 4:b0ce6385d008 | 88 | pc.printf("Please eneter a debug option: \n\r" |
| SDesign2018 | 4:b0ce6385d008 | 89 | "1: Read converted values from Accelerometer ADXL372\n\r" |
| SDesign2018 | 4:b0ce6385d008 | 90 | "2: Read converted values from Temperature ADT7410\n\r" |
| SDesign2018 | 4:b0ce6385d008 | 91 | "3: Read raw values from Accelerometer ADXL372\n\r" |
| SDesign2018 | 4:b0ce6385d008 | 92 | "4: Read raw values from Temperature ADT7410\n\r" |
| SDesign2018 | 4:b0ce6385d008 | 93 | "5: Initialize Accelerometer\n\r" |
| SDesign2018 | 4:b0ce6385d008 | 94 | "6: Reset Accelerometer\n\r" |
| SDesign2018 | 4:b0ce6385d008 | 95 | "7: Send Temperature data\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 96 | } |
| SDesign2018 | 4:b0ce6385d008 | 97 | |
| SDesign2018 | 4:b0ce6385d008 | 98 | |
| SDesign2018 | 4:b0ce6385d008 | 99 | /******************************************************************************* |
| SDesign2018 | 4:b0ce6385d008 | 100 | * Function to be called by the ticker interrupt |
| SDesign2018 | 4:b0ce6385d008 | 101 | * Read temperatures and send it |
| SDesign2018 | 4:b0ce6385d008 | 102 | * |
| SDesign2018 | 4:b0ce6385d008 | 103 | * |
| SDesign2018 | 4:b0ce6385d008 | 104 | ******************************************************************************/ |
| SDesign2018 | 4:b0ce6385d008 | 105 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 106 | void interruptReadTemperature(void){ |
| SDesign2018 | 4:b0ce6385d008 | 107 | std::vector<uint8_t> tx_data; |
| SDesign2018 | 4:b0ce6385d008 | 108 | uint16_t temperatures; |
| SDesign2018 | 4:b0ce6385d008 | 109 | char data[2] = {0, 0}; |
| SDesign2018 | 4:b0ce6385d008 | 110 | char cmd[1]; |
| SDesign2018 | 4:b0ce6385d008 | 111 | cmd[0] = 0x00; |
| SDesign2018 | 4:b0ce6385d008 | 112 | //pc.printf("Register Addres is: %x \n\r", cmd[0]); |
| SDesign2018 | 4:b0ce6385d008 | 113 | if(ADT7410.write(ADT7410_Address_8BIT, cmd,1) == 0){ |
| SDesign2018 | 4:b0ce6385d008 | 114 | if(ADT7410.read(ADT7410_Address_8BIT, data, 2) == 0){ |
| SDesign2018 | 4:b0ce6385d008 | 115 | temperatures = ((data[0] << 8) | data[1]) >> 3; |
| SDesign2018 | 4:b0ce6385d008 | 116 | tx_data.push_back((temperatures >> 8) & 0xFF); |
| SDesign2018 | 4:b0ce6385d008 | 117 | tx_data.push_back(temperatures & 0xFF); |
| SDesign2018 | 4:b0ce6385d008 | 118 | logInfo("light: %lu [0x%04X]", temperatures, temperatures); |
| SDesign2018 | 4:b0ce6385d008 | 119 | send_data(tx_data); |
| SDesign2018 | 4:b0ce6385d008 | 120 | //return (data[0] >> 8 | data[1])>>3; // Explained here: https://stackoverflow.com/a/141576 SOOO GOOOOODDD |
| SDesign2018 | 4:b0ce6385d008 | 121 | |
| SDesign2018 | 4:b0ce6385d008 | 122 | } |
| SDesign2018 | 4:b0ce6385d008 | 123 | } |
| SDesign2018 | 4:b0ce6385d008 | 124 | } |
| SDesign2018 | 4:b0ce6385d008 | 125 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 126 | |
| SDesign2018 | 4:b0ce6385d008 | 127 | int main() { |
| SDesign2018 | 4:b0ce6385d008 | 128 | // Custom event handler for automatically displaying RX data |
| SDesign2018 | 4:b0ce6385d008 | 129 | interruptEverything.attach(&interruptReadTemperature, 7.0); |
| SDesign2018 | 4:b0ce6385d008 | 130 | RadioEvent events; |
| SDesign2018 | 4:b0ce6385d008 | 131 | uint32_t tx_frequency; |
| SDesign2018 | 4:b0ce6385d008 | 132 | uint8_t tx_datarate; |
| SDesign2018 | 4:b0ce6385d008 | 133 | uint8_t tx_power; |
| SDesign2018 | 4:b0ce6385d008 | 134 | uint8_t frequency_band; |
| SDesign2018 | 4:b0ce6385d008 | 135 | |
| SDesign2018 | 4:b0ce6385d008 | 136 | // Points to the returned char pointer from called functions |
| SDesign2018 | 4:b0ce6385d008 | 137 | char * rawTempValues; // Could change to uint8_t, same for other char pointers |
| SDesign2018 | 4:b0ce6385d008 | 138 | |
| SDesign2018 | 4:b0ce6385d008 | 139 | // Save converted values here |
| SDesign2018 | 4:b0ce6385d008 | 140 | uint16_t convertedTempValue; // Data values must be uint16_t for conversion and send prep |
| SDesign2018 | 4:b0ce6385d008 | 141 | char *accelValues; |
| SDesign2018 | 4:b0ce6385d008 | 142 | uint16_t XData; |
| SDesign2018 | 4:b0ce6385d008 | 143 | uint16_t YData; |
| SDesign2018 | 4:b0ce6385d008 | 144 | uint16_t ZData; |
| SDesign2018 | 4:b0ce6385d008 | 145 | int regAddress; |
| SDesign2018 | 4:b0ce6385d008 | 146 | |
| SDesign2018 | 4:b0ce6385d008 | 147 | // Change baud rate in serial terminal to this value |
| SDesign2018 | 4:b0ce6385d008 | 148 | pc.baud(115200); |
| SDesign2018 | 4:b0ce6385d008 | 149 | |
| SDesign2018 | 4:b0ce6385d008 | 150 | |
| SDesign2018 | 4:b0ce6385d008 | 151 | mts::MTSLog::setLogLevel(mts::MTSLog::TRACE_LEVEL); |
| SDesign2018 | 4:b0ce6385d008 | 152 | |
| SDesign2018 | 4:b0ce6385d008 | 153 | // Sometimes when calling this, it creates error: type specifier expected |
| SDesign2018 | 4:b0ce6385d008 | 154 | // Even with identical include files I would get this in another workspace. |
| SDesign2018 | 4:b0ce6385d008 | 155 | plan = new lora::ChannelPlan_US915(); |
| SDesign2018 | 4:b0ce6385d008 | 156 | |
| SDesign2018 | 4:b0ce6385d008 | 157 | logInfo("Now asserting"); |
| SDesign2018 | 4:b0ce6385d008 | 158 | assert(plan); |
| SDesign2018 | 4:b0ce6385d008 | 159 | |
| SDesign2018 | 4:b0ce6385d008 | 160 | // Careful when using this. The production ready libmdot-mbed5 has a void constructor |
| SDesign2018 | 4:b0ce6385d008 | 161 | // Therefore, can only use the libmDot-dev-mbed5 version, for now. |
| SDesign2018 | 4:b0ce6385d008 | 162 | dot = mDot::getInstance(plan); |
| SDesign2018 | 4:b0ce6385d008 | 163 | assert(dot); |
| SDesign2018 | 4:b0ce6385d008 | 164 | |
| SDesign2018 | 4:b0ce6385d008 | 165 | logInfo("mbed-os library version: %d", MBED_LIBRARY_VERSION); |
| SDesign2018 | 4:b0ce6385d008 | 166 | |
| SDesign2018 | 4:b0ce6385d008 | 167 | // start from a well-known state |
| SDesign2018 | 4:b0ce6385d008 | 168 | logInfo("defaulting Dot configuration"); |
| SDesign2018 | 4:b0ce6385d008 | 169 | dot->resetConfig(); |
| SDesign2018 | 4:b0ce6385d008 | 170 | |
| SDesign2018 | 4:b0ce6385d008 | 171 | // make sure library logging is turned on |
| SDesign2018 | 4:b0ce6385d008 | 172 | dot->setLogLevel(mts::MTSLog::INFO_LEVEL); |
| SDesign2018 | 4:b0ce6385d008 | 173 | |
| SDesign2018 | 4:b0ce6385d008 | 174 | // attach the custom events handler |
| SDesign2018 | 4:b0ce6385d008 | 175 | dot->setEvents(&events); |
| SDesign2018 | 4:b0ce6385d008 | 176 | |
| SDesign2018 | 4:b0ce6385d008 | 177 | // update configuration if necessary |
| SDesign2018 | 4:b0ce6385d008 | 178 | if (dot->getJoinMode() != mDot::PEER_TO_PEER) { |
| SDesign2018 | 4:b0ce6385d008 | 179 | logInfo("changing network join mode to PEER_TO_PEER"); |
| SDesign2018 | 4:b0ce6385d008 | 180 | if (dot->setJoinMode(mDot::PEER_TO_PEER) != mDot::MDOT_OK) { |
| SDesign2018 | 4:b0ce6385d008 | 181 | logError("failed to set network join mode to PEER_TO_PEER"); |
| SDesign2018 | 4:b0ce6385d008 | 182 | } |
| SDesign2018 | 4:b0ce6385d008 | 183 | } |
| SDesign2018 | 4:b0ce6385d008 | 184 | |
| SDesign2018 | 4:b0ce6385d008 | 185 | /* |
| SDesign2018 | 4:b0ce6385d008 | 186 | * Get the Frequency and then choose transfer frequency, datarate, and power accordingly |
| SDesign2018 | 4:b0ce6385d008 | 187 | * |
| SDesign2018 | 4:b0ce6385d008 | 188 | */ |
| SDesign2018 | 4:b0ce6385d008 | 189 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 190 | frequency_band = dot->getFrequencyBand(); |
| SDesign2018 | 4:b0ce6385d008 | 191 | switch (frequency_band) { |
| SDesign2018 | 4:b0ce6385d008 | 192 | case lora::ChannelPlan::EU868_OLD: |
| SDesign2018 | 4:b0ce6385d008 | 193 | case lora::ChannelPlan::EU868: |
| SDesign2018 | 4:b0ce6385d008 | 194 | // 250kHz channels achieve higher throughput |
| SDesign2018 | 4:b0ce6385d008 | 195 | // DR_6 : SF7 @ 250kHz |
| SDesign2018 | 4:b0ce6385d008 | 196 | // DR_0 - DR_5 (125kHz channels) available but much slower |
| SDesign2018 | 4:b0ce6385d008 | 197 | tx_frequency = 869850000; |
| SDesign2018 | 4:b0ce6385d008 | 198 | tx_datarate = lora::DR_6; |
| SDesign2018 | 4:b0ce6385d008 | 199 | // the 869850000 frequency is 100% duty cycle if the total power is under 7 dBm - tx power 4 + antenna gain 3 = 7 |
| SDesign2018 | 4:b0ce6385d008 | 200 | tx_power = 4; |
| SDesign2018 | 4:b0ce6385d008 | 201 | break; |
| SDesign2018 | 4:b0ce6385d008 | 202 | |
| SDesign2018 | 4:b0ce6385d008 | 203 | case lora::ChannelPlan::US915_OLD: |
| SDesign2018 | 4:b0ce6385d008 | 204 | case lora::ChannelPlan::US915: |
| SDesign2018 | 4:b0ce6385d008 | 205 | case lora::ChannelPlan::AU915_OLD: |
| SDesign2018 | 4:b0ce6385d008 | 206 | case lora::ChannelPlan::AU915: |
| SDesign2018 | 4:b0ce6385d008 | 207 | // 500kHz channels achieve highest throughput |
| SDesign2018 | 4:b0ce6385d008 | 208 | // DR_8 : SF12 @ 500kHz |
| SDesign2018 | 4:b0ce6385d008 | 209 | // DR_9 : SF11 @ 500kHz |
| SDesign2018 | 4:b0ce6385d008 | 210 | // DR_10 : SF10 @ 500kHz |
| SDesign2018 | 4:b0ce6385d008 | 211 | // DR_11 : SF9 @ 500kHz |
| SDesign2018 | 4:b0ce6385d008 | 212 | // DR_12 : SF8 @ 500kHz |
| SDesign2018 | 4:b0ce6385d008 | 213 | // DR_13 : SF7 @ 500kHz |
| SDesign2018 | 4:b0ce6385d008 | 214 | // DR_0 - DR_3 (125kHz channels) available but much slower |
| SDesign2018 | 4:b0ce6385d008 | 215 | tx_frequency = 915500000; |
| SDesign2018 | 4:b0ce6385d008 | 216 | tx_datarate = lora::DR_13; |
| SDesign2018 | 4:b0ce6385d008 | 217 | // 915 bands have no duty cycle restrictions, set tx power to max |
| SDesign2018 | 4:b0ce6385d008 | 218 | tx_power = 20; |
| SDesign2018 | 4:b0ce6385d008 | 219 | break; |
| SDesign2018 | 4:b0ce6385d008 | 220 | |
| SDesign2018 | 4:b0ce6385d008 | 221 | case lora::ChannelPlan::AS923: |
| SDesign2018 | 4:b0ce6385d008 | 222 | case lora::ChannelPlan::AS923_JAPAN: |
| SDesign2018 | 4:b0ce6385d008 | 223 | // 250kHz channels achieve higher throughput |
| SDesign2018 | 4:b0ce6385d008 | 224 | // DR_6 : SF7 @ 250kHz |
| SDesign2018 | 4:b0ce6385d008 | 225 | // DR_0 - DR_5 (125kHz channels) available but much slower |
| SDesign2018 | 4:b0ce6385d008 | 226 | tx_frequency = 924800000; |
| SDesign2018 | 4:b0ce6385d008 | 227 | tx_datarate = lora::DR_6; |
| SDesign2018 | 4:b0ce6385d008 | 228 | tx_power = 16; |
| SDesign2018 | 4:b0ce6385d008 | 229 | break; |
| SDesign2018 | 4:b0ce6385d008 | 230 | |
| SDesign2018 | 4:b0ce6385d008 | 231 | case lora::ChannelPlan::KR920: |
| SDesign2018 | 4:b0ce6385d008 | 232 | // DR_5 : SF7 @ 125kHz |
| SDesign2018 | 4:b0ce6385d008 | 233 | tx_frequency = 922700000; |
| SDesign2018 | 4:b0ce6385d008 | 234 | tx_datarate = lora::DR_5; |
| SDesign2018 | 4:b0ce6385d008 | 235 | tx_power = 14; |
| SDesign2018 | 4:b0ce6385d008 | 236 | break; |
| SDesign2018 | 4:b0ce6385d008 | 237 | |
| SDesign2018 | 4:b0ce6385d008 | 238 | default: |
| SDesign2018 | 4:b0ce6385d008 | 239 | while (true) { |
| SDesign2018 | 4:b0ce6385d008 | 240 | logFatal("no known channel plan in use - extra configuration is needed!"); |
| SDesign2018 | 4:b0ce6385d008 | 241 | wait(5); |
| SDesign2018 | 4:b0ce6385d008 | 242 | } |
| SDesign2018 | 4:b0ce6385d008 | 243 | break; |
| SDesign2018 | 4:b0ce6385d008 | 244 | } |
| SDesign2018 | 4:b0ce6385d008 | 245 | |
| SDesign2018 | 4:b0ce6385d008 | 246 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 247 | |
| SDesign2018 | 4:b0ce6385d008 | 248 | // in PEER_TO_PEER mode there is no join request/response transaction |
| SDesign2018 | 4:b0ce6385d008 | 249 | // as long as both Dots are configured correctly, they should be able to communicate |
| SDesign2018 | 4:b0ce6385d008 | 250 | update_peer_to_peer_config(network_address, network_session_key, data_session_key, tx_frequency, tx_datarate, tx_power); |
| SDesign2018 | 4:b0ce6385d008 | 251 | |
| SDesign2018 | 4:b0ce6385d008 | 252 | // save changes to configuration |
| SDesign2018 | 4:b0ce6385d008 | 253 | logInfo("saving configuration"); |
| SDesign2018 | 4:b0ce6385d008 | 254 | if (!dot->saveConfig()) { |
| SDesign2018 | 4:b0ce6385d008 | 255 | logError("failed to save configuration"); |
| SDesign2018 | 4:b0ce6385d008 | 256 | } |
| SDesign2018 | 4:b0ce6385d008 | 257 | |
| SDesign2018 | 4:b0ce6385d008 | 258 | // Display configuration |
| SDesign2018 | 4:b0ce6385d008 | 259 | // It's gonna output a lot of information onto the Serial Terminal |
| SDesign2018 | 4:b0ce6385d008 | 260 | display_config(); |
| SDesign2018 | 4:b0ce6385d008 | 261 | |
| SDesign2018 | 4:b0ce6385d008 | 262 | /* |
| SDesign2018 | 4:b0ce6385d008 | 263 | * |
| SDesign2018 | 4:b0ce6385d008 | 264 | * From here on is my own code |
| SDesign2018 | 4:b0ce6385d008 | 265 | * Can add more options to choose from |
| SDesign2018 | 4:b0ce6385d008 | 266 | * |
| SDesign2018 | 4:b0ce6385d008 | 267 | */ |
| SDesign2018 | 4:b0ce6385d008 | 268 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 269 | printMenu(); |
| SDesign2018 | 4:b0ce6385d008 | 270 | pc.printf("\n\rChoose what you want to do: \n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 271 | |
| SDesign2018 | 4:b0ce6385d008 | 272 | char userInput = pc.getc(); |
| SDesign2018 | 4:b0ce6385d008 | 273 | while(1){ |
| SDesign2018 | 4:b0ce6385d008 | 274 | // Create a vector of uint8_t elements to be sent later |
| SDesign2018 | 4:b0ce6385d008 | 275 | std::vector<uint8_t> tx_data; |
| SDesign2018 | 4:b0ce6385d008 | 276 | |
| SDesign2018 | 4:b0ce6385d008 | 277 | // Checks if a character has been pressed; |
| SDesign2018 | 4:b0ce6385d008 | 278 | // Works right now for 1 digit numbers :( |
| SDesign2018 | 4:b0ce6385d008 | 279 | // Change to work with larger inputs |
| SDesign2018 | 4:b0ce6385d008 | 280 | if(pc.readable()) |
| SDesign2018 | 4:b0ce6385d008 | 281 | { |
| SDesign2018 | 4:b0ce6385d008 | 282 | userInput = pc.getc(); |
| SDesign2018 | 4:b0ce6385d008 | 283 | switch(userInput){ |
| SDesign2018 | 4:b0ce6385d008 | 284 | case 49: // 1 |
| SDesign2018 | 4:b0ce6385d008 | 285 | pc.printf("Reading converted values from accelerometer\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 286 | for(int i = 0; i < 15; ++i){ |
| SDesign2018 | 4:b0ce6385d008 | 287 | regAddress = 0x08; // This is the register address for XData |
| SDesign2018 | 4:b0ce6385d008 | 288 | accelValues = accelerometerI2CRead(regAddress); |
| SDesign2018 | 4:b0ce6385d008 | 289 | XData = ((*(accelValues + 0) << 8) | *(accelValues + 1)) >> 4; // Combine two bytes into short in, remove last 4 flag bits |
| SDesign2018 | 4:b0ce6385d008 | 290 | YData = ((*(accelValues + 2) << 8) | *(accelValues + 3)) >> 4; |
| SDesign2018 | 4:b0ce6385d008 | 291 | ZData = ((*(accelValues + 4) << 8) | *(accelValues + 5)) >> 4; |
| SDesign2018 | 4:b0ce6385d008 | 292 | pc.printf("\n %d: X: 0x%x | Y: 0x%x | Z: 0x%x \n\r", i+1, XData, YData, ZData); |
| SDesign2018 | 4:b0ce6385d008 | 293 | wait(0.2); |
| SDesign2018 | 4:b0ce6385d008 | 294 | } |
| SDesign2018 | 4:b0ce6385d008 | 295 | break; |
| SDesign2018 | 4:b0ce6385d008 | 296 | case 50: // 2 |
| SDesign2018 | 4:b0ce6385d008 | 297 | pc.printf("Reading converted values from temperature\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 298 | for(int i = 0; i < 10; ++i){ |
| SDesign2018 | 4:b0ce6385d008 | 299 | regAddress = 0x00; |
| SDesign2018 | 4:b0ce6385d008 | 300 | rawTempValues = ADT7410Read(regAddress); |
| SDesign2018 | 4:b0ce6385d008 | 301 | convertedTempValue = ((*(rawTempValues + 0) << 8) | *(rawTempValues + 1)) >> 3; // Combine the two bytes into |
| SDesign2018 | 4:b0ce6385d008 | 302 | // a short int variable, remove last 3 |
| SDesign2018 | 4:b0ce6385d008 | 303 | |
| SDesign2018 | 4:b0ce6385d008 | 304 | pc.printf("\n %d: Temperature is: 0x%x \n\r", i+1, convertedTempValue); |
| SDesign2018 | 4:b0ce6385d008 | 305 | } |
| SDesign2018 | 4:b0ce6385d008 | 306 | |
| SDesign2018 | 4:b0ce6385d008 | 307 | break; |
| SDesign2018 | 4:b0ce6385d008 | 308 | case 51: // 3 |
| SDesign2018 | 4:b0ce6385d008 | 309 | pc.printf("Reading raw values from accelerometer\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 310 | for(int i = 0; i < 15; ++i){ |
| SDesign2018 | 4:b0ce6385d008 | 311 | regAddress = 0x08; |
| SDesign2018 | 4:b0ce6385d008 | 312 | accelValues = accelerometerI2CRead(regAddress); |
| SDesign2018 | 4:b0ce6385d008 | 313 | XData = ((*(accelValues + 0) << 8) | *(accelValues + 1)) >> 4; // Combine two bytes into short in, remove last 4 flag bits |
| SDesign2018 | 4:b0ce6385d008 | 314 | YData = ((*(accelValues + 2) << 8) | *(accelValues + 3)) >> 4; |
| SDesign2018 | 4:b0ce6385d008 | 315 | ZData = ((*(accelValues + 4) << 8) | *(accelValues + 5)) >> 4; |
| SDesign2018 | 4:b0ce6385d008 | 316 | pc.printf("\n %d: X:: H: %x | L: %x | Y:: H: %x | L: %x | Z: H: %x | L: %x \n\r", i+1, *(accelValues + 0), *(accelValues + 1), *(accelValues + 2), *(accelValues + 3), *(accelValues + 4), *(accelValues + 5)); |
| SDesign2018 | 4:b0ce6385d008 | 317 | wait(0.2); |
| SDesign2018 | 4:b0ce6385d008 | 318 | } |
| SDesign2018 | 4:b0ce6385d008 | 319 | break; |
| SDesign2018 | 4:b0ce6385d008 | 320 | case 52: // 4 |
| SDesign2018 | 4:b0ce6385d008 | 321 | pc.printf("Reading raw values from temperature\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 322 | for(int i = 0; i < 10; ++i){ |
| SDesign2018 | 4:b0ce6385d008 | 323 | regAddress = 0x00; |
| SDesign2018 | 4:b0ce6385d008 | 324 | rawTempValues = ADT7410Read(regAddress); |
| SDesign2018 | 4:b0ce6385d008 | 325 | pc.printf("\n %d: Temperature is: HIGH BYTE: %x | LOW BYTE: %x \n\r", i+1, *(rawTempValues + 0), *(rawTempValues + 1)); |
| SDesign2018 | 4:b0ce6385d008 | 326 | } |
| SDesign2018 | 4:b0ce6385d008 | 327 | break; |
| SDesign2018 | 4:b0ce6385d008 | 328 | case 53: // 5 |
| SDesign2018 | 4:b0ce6385d008 | 329 | ADXL372Initialize(); |
| SDesign2018 | 4:b0ce6385d008 | 330 | break; |
| SDesign2018 | 4:b0ce6385d008 | 331 | case 54: // 6 |
| SDesign2018 | 4:b0ce6385d008 | 332 | ADXL372Reset(); |
| SDesign2018 | 4:b0ce6385d008 | 333 | break; |
| SDesign2018 | 4:b0ce6385d008 | 334 | |
| SDesign2018 | 4:b0ce6385d008 | 335 | case 55: // 7 |
| SDesign2018 | 4:b0ce6385d008 | 336 | regAddress = 0x00; |
| SDesign2018 | 4:b0ce6385d008 | 337 | rawTempValues = ADT7410Read(regAddress); |
| SDesign2018 | 4:b0ce6385d008 | 338 | convertedTempValue = ((*(rawTempValues + 0) << 8) | *(rawTempValues + 1)) >> 3; // Combine the two bytes |
| SDesign2018 | 4:b0ce6385d008 | 339 | |
| SDesign2018 | 4:b0ce6385d008 | 340 | tx_data.push_back((convertedTempValue >> 8) & 0xFF); |
| SDesign2018 | 4:b0ce6385d008 | 341 | tx_data.push_back(convertedTempValue & 0xFF); |
| SDesign2018 | 4:b0ce6385d008 | 342 | logInfo("light: %lu [0x%04X]", convertedTempValue, convertedTempValue); |
| SDesign2018 | 4:b0ce6385d008 | 343 | send_data(tx_data); |
| SDesign2018 | 4:b0ce6385d008 | 344 | |
| SDesign2018 | 4:b0ce6385d008 | 345 | default: |
| SDesign2018 | 4:b0ce6385d008 | 346 | printMenu(); |
| SDesign2018 | 4:b0ce6385d008 | 347 | break; |
| SDesign2018 | 4:b0ce6385d008 | 348 | } |
| SDesign2018 | 4:b0ce6385d008 | 349 | } |
| SDesign2018 | 4:b0ce6385d008 | 350 | |
| SDesign2018 | 4:b0ce6385d008 | 351 | } |
| SDesign2018 | 4:b0ce6385d008 | 352 | |
| SDesign2018 | 4:b0ce6385d008 | 353 | return 0; |
| SDesign2018 | 4:b0ce6385d008 | 354 | } |
| SDesign2018 | 4:b0ce6385d008 | 355 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 356 | |
| SDesign2018 | 4:b0ce6385d008 | 357 | |
| SDesign2018 | 4:b0ce6385d008 | 358 | /******************************************************************************* |
| SDesign2018 | 4:b0ce6385d008 | 359 | * |
| SDesign2018 | 4:b0ce6385d008 | 360 | * I2C function for the the ADXL372 accelerometer for a write sequence |
| SDesign2018 | 4:b0ce6385d008 | 361 | * Param: |
| SDesign2018 | 4:b0ce6385d008 | 362 | * hexAddress: Pass the hexadecimal value for what register you want |
| SDesign2018 | 4:b0ce6385d008 | 363 | * hexData: Pass the hexadecimal value for what data you want to send |
| SDesign2018 | 4:b0ce6385d008 | 364 | * i.e. hexadecimal represenatation of certain bits |
| SDesign2018 | 4:b0ce6385d008 | 365 | * Returns: |
| SDesign2018 | 4:b0ce6385d008 | 366 | * 1: Write was a complete success |
| SDesign2018 | 4:b0ce6385d008 | 367 | * 2: Writing data to register failed |
| SDesign2018 | 4:b0ce6385d008 | 368 | * 3: Writing to register Address failed |
| SDesign2018 | 4:b0ce6385d008 | 369 | ******************************************************************************/ |
| SDesign2018 | 4:b0ce6385d008 | 370 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 371 | int accelerometerI2CWrite(int hexAddress, int hexData){ |
| SDesign2018 | 4:b0ce6385d008 | 372 | //--------- One full writing cycle for ADXL372 for X enable ------------------// |
| SDesign2018 | 4:b0ce6385d008 | 373 | /* '0' - NAK was received |
| SDesign2018 | 4:b0ce6385d008 | 374 | * '1' - ACK was received, <---- This good |
| SDesign2018 | 4:b0ce6385d008 | 375 | * '2' - timeout |
| SDesign2018 | 4:b0ce6385d008 | 376 | */ |
| SDesign2018 | 4:b0ce6385d008 | 377 | int flag; |
| SDesign2018 | 4:b0ce6385d008 | 378 | int registerAddress = hexAddress; |
| SDesign2018 | 4:b0ce6385d008 | 379 | int data = hexData; |
| SDesign2018 | 4:b0ce6385d008 | 380 | |
| SDesign2018 | 4:b0ce6385d008 | 381 | ADXL372.start(); |
| SDesign2018 | 4:b0ce6385d008 | 382 | flag = ADXL372.write(ADXL372_Address_8bit); |
| SDesign2018 | 4:b0ce6385d008 | 383 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 384 | { |
| SDesign2018 | 4:b0ce6385d008 | 385 | pc.printf("Write to I2C address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 386 | wait(0.1); |
| SDesign2018 | 4:b0ce6385d008 | 387 | flag = ADXL372.write(registerAddress); |
| SDesign2018 | 4:b0ce6385d008 | 388 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 389 | { |
| SDesign2018 | 4:b0ce6385d008 | 390 | pc.printf("Write to register 0x%x address success\n\r", registerAddress); |
| SDesign2018 | 4:b0ce6385d008 | 391 | flag = ADXL372.write(data); |
| SDesign2018 | 4:b0ce6385d008 | 392 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 393 | { |
| SDesign2018 | 4:b0ce6385d008 | 394 | pc.printf("Writing data 0x%x to register address success\n\r", data); |
| SDesign2018 | 4:b0ce6385d008 | 395 | ADXL372.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 396 | return 1; |
| SDesign2018 | 4:b0ce6385d008 | 397 | }else {ADXL372.stop(); return 2;} |
| SDesign2018 | 4:b0ce6385d008 | 398 | }else {ADXL372.stop(); return 3;} |
| SDesign2018 | 4:b0ce6385d008 | 399 | }else ADXL372.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 400 | |
| SDesign2018 | 4:b0ce6385d008 | 401 | return 0; |
| SDesign2018 | 4:b0ce6385d008 | 402 | // ---------------- End of writing cycle --------------------------// |
| SDesign2018 | 4:b0ce6385d008 | 403 | } |
| SDesign2018 | 4:b0ce6385d008 | 404 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 405 | |
| SDesign2018 | 4:b0ce6385d008 | 406 | |
| SDesign2018 | 4:b0ce6385d008 | 407 | /******************************************************************************* |
| SDesign2018 | 4:b0ce6385d008 | 408 | * I2C read sequence for the accelerometer |
| SDesign2018 | 4:b0ce6385d008 | 409 | * Param: |
| SDesign2018 | 4:b0ce6385d008 | 410 | * hexAddress: pass the hexadecimal representation of desired Register address |
| SDesign2018 | 4:b0ce6385d008 | 411 | * Return: |
| SDesign2018 | 4:b0ce6385d008 | 412 | * Char pointer to the array of read data. |
| SDesign2018 | 4:b0ce6385d008 | 413 | * |
| SDesign2018 | 4:b0ce6385d008 | 414 | * Right now it works only for the XData, YData, ZData because I wrote it to read |
| SDesign2018 | 4:b0ce6385d008 | 415 | * 6 bytes(6 registers). |
| SDesign2018 | 4:b0ce6385d008 | 416 | * Should change it to be 1 byte at a time |
| SDesign2018 | 4:b0ce6385d008 | 417 | ******************************************************************************/ |
| SDesign2018 | 4:b0ce6385d008 | 418 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 419 | char * accelerometerI2CRead(int hexAddress){ |
| SDesign2018 | 4:b0ce6385d008 | 420 | char accelData[6]; |
| SDesign2018 | 4:b0ce6385d008 | 421 | char registerAddress[1]; |
| SDesign2018 | 4:b0ce6385d008 | 422 | registerAddress[0] = hexAddress; |
| SDesign2018 | 4:b0ce6385d008 | 423 | |
| SDesign2018 | 4:b0ce6385d008 | 424 | // Perform mbed's way sending a start bit, then device address[r/~w], and then the register address |
| SDesign2018 | 4:b0ce6385d008 | 425 | // Also if it succeeds, continue to the next operation |
| SDesign2018 | 4:b0ce6385d008 | 426 | if(ADXL372.write(ADXL372_Address_8bit, registerAddress, 1) == 0){ |
| SDesign2018 | 4:b0ce6385d008 | 427 | |
| SDesign2018 | 4:b0ce6385d008 | 428 | // If previous sequence works, get 6 bytes into char array accelData |
| SDesign2018 | 4:b0ce6385d008 | 429 | // Char array because it uses 1 byte(8bits) |
| SDesign2018 | 4:b0ce6385d008 | 430 | // Should probably change it to uint8_t type |
| SDesign2018 | 4:b0ce6385d008 | 431 | if(ADXL372.read(ADXL372_Address_8bit, accelData, 6) == 0){ |
| SDesign2018 | 4:b0ce6385d008 | 432 | return accelData; |
| SDesign2018 | 4:b0ce6385d008 | 433 | }else pc.printf("Failed to read\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 434 | }else pc.printf("Failed to write\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 435 | return 0; // Only if it fails |
| SDesign2018 | 4:b0ce6385d008 | 436 | } |
| SDesign2018 | 4:b0ce6385d008 | 437 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 438 | |
| SDesign2018 | 4:b0ce6385d008 | 439 | |
| SDesign2018 | 4:b0ce6385d008 | 440 | |
| SDesign2018 | 4:b0ce6385d008 | 441 | /******************************************************************************* |
| SDesign2018 | 4:b0ce6385d008 | 442 | * Initializes whatever settings you want for the accelerometer |
| SDesign2018 | 4:b0ce6385d008 | 443 | * Can change it to use the previous I2C write function instead of all this mess |
| SDesign2018 | 4:b0ce6385d008 | 444 | * |
| SDesign2018 | 4:b0ce6385d008 | 445 | ******************************************************************************/ |
| SDesign2018 | 4:b0ce6385d008 | 446 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 447 | void ADXL372Initialize(void){ |
| SDesign2018 | 4:b0ce6385d008 | 448 | int flag; |
| SDesign2018 | 4:b0ce6385d008 | 449 | |
| SDesign2018 | 4:b0ce6385d008 | 450 | //--------- Change mode to full Bandwidth Measurement Mode ------------------// |
| SDesign2018 | 4:b0ce6385d008 | 451 | /* '0' - NAK was received |
| SDesign2018 | 4:b0ce6385d008 | 452 | * '1' - ACK was received, <---- This good |
| SDesign2018 | 4:b0ce6385d008 | 453 | * '2' - timeout |
| SDesign2018 | 4:b0ce6385d008 | 454 | */ |
| SDesign2018 | 4:b0ce6385d008 | 455 | pc.printf("Initializing Single Byte write\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 456 | ADXL372.start(); // Send start |
| SDesign2018 | 4:b0ce6385d008 | 457 | flag = ADXL372.write(ADXL372_Address_8bit | 0); // Send Device Address |
| SDesign2018 | 4:b0ce6385d008 | 458 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 459 | { |
| SDesign2018 | 4:b0ce6385d008 | 460 | pc.printf("Write to I2C address for write success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 461 | wait(0.1); |
| SDesign2018 | 4:b0ce6385d008 | 462 | flag = ADXL372.write(0x3F); // Send Register Address |
| SDesign2018 | 4:b0ce6385d008 | 463 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 464 | { |
| SDesign2018 | 4:b0ce6385d008 | 465 | |
| SDesign2018 | 4:b0ce6385d008 | 466 | pc.printf("Write to 0x3F register address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 467 | flag = ADXL372.write(0x03); // Send Data that represents Full BandWidth mode |
| SDesign2018 | 4:b0ce6385d008 | 468 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 469 | { |
| SDesign2018 | 4:b0ce6385d008 | 470 | pc.printf("Write data to register address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 471 | ADXL372.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 472 | } |
| SDesign2018 | 4:b0ce6385d008 | 473 | } |
| SDesign2018 | 4:b0ce6385d008 | 474 | } |
| SDesign2018 | 4:b0ce6385d008 | 475 | else ADXL372.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 476 | // ---------------- End of writing cycle --------------------------// |
| SDesign2018 | 4:b0ce6385d008 | 477 | |
| SDesign2018 | 4:b0ce6385d008 | 478 | //--------- One full writing cycle for ADXL372 for X enable ------------------// |
| SDesign2018 | 4:b0ce6385d008 | 479 | /* '0' - NAK was received |
| SDesign2018 | 4:b0ce6385d008 | 480 | * '1' - ACK was received, <---- This good |
| SDesign2018 | 4:b0ce6385d008 | 481 | * '2' - timeout |
| SDesign2018 | 4:b0ce6385d008 | 482 | */ |
| SDesign2018 | 4:b0ce6385d008 | 483 | ADXL372.start(); |
| SDesign2018 | 4:b0ce6385d008 | 484 | flag = ADXL372.write(ADXL372_Address_8bit); |
| SDesign2018 | 4:b0ce6385d008 | 485 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 486 | { |
| SDesign2018 | 4:b0ce6385d008 | 487 | pc.printf("Write to I2C address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 488 | wait(0.1); |
| SDesign2018 | 4:b0ce6385d008 | 489 | flag = ADXL372.write(0x24); |
| SDesign2018 | 4:b0ce6385d008 | 490 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 491 | { |
| SDesign2018 | 4:b0ce6385d008 | 492 | pc.printf("Write to register 0x24 address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 493 | flag = ADXL372.write(0x01); |
| SDesign2018 | 4:b0ce6385d008 | 494 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 495 | { |
| SDesign2018 | 4:b0ce6385d008 | 496 | pc.printf("Write data to register address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 497 | pc.printf("X Enable should be set now\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 498 | ADXL372.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 499 | } |
| SDesign2018 | 4:b0ce6385d008 | 500 | } |
| SDesign2018 | 4:b0ce6385d008 | 501 | } |
| SDesign2018 | 4:b0ce6385d008 | 502 | else ADXL372.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 503 | // ---------------- End of writing cycle --------------------------// |
| SDesign2018 | 4:b0ce6385d008 | 504 | |
| SDesign2018 | 4:b0ce6385d008 | 505 | //--------- One full writing cycle for ADXL372 for Y Enable ------------------// |
| SDesign2018 | 4:b0ce6385d008 | 506 | /* '0' - NAK was received |
| SDesign2018 | 4:b0ce6385d008 | 507 | * '1' - ACK was received, <---- This good |
| SDesign2018 | 4:b0ce6385d008 | 508 | * '2' - timeout |
| SDesign2018 | 4:b0ce6385d008 | 509 | */ |
| SDesign2018 | 4:b0ce6385d008 | 510 | ADXL372.start(); |
| SDesign2018 | 4:b0ce6385d008 | 511 | flag = ADXL372.write(ADXL372_Address_8bit); |
| SDesign2018 | 4:b0ce6385d008 | 512 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 513 | { |
| SDesign2018 | 4:b0ce6385d008 | 514 | pc.printf("Write to I2C address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 515 | wait(0.1); |
| SDesign2018 | 4:b0ce6385d008 | 516 | flag = ADXL372.write(0x25); |
| SDesign2018 | 4:b0ce6385d008 | 517 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 518 | { |
| SDesign2018 | 4:b0ce6385d008 | 519 | pc.printf("Write to 0x25 register address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 520 | flag = ADXL372.write(0x01); |
| SDesign2018 | 4:b0ce6385d008 | 521 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 522 | { |
| SDesign2018 | 4:b0ce6385d008 | 523 | pc.printf("Write data to register address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 524 | pc.printf("Y Enable should be set now\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 525 | |
| SDesign2018 | 4:b0ce6385d008 | 526 | ADXL372.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 527 | } |
| SDesign2018 | 4:b0ce6385d008 | 528 | } |
| SDesign2018 | 4:b0ce6385d008 | 529 | } |
| SDesign2018 | 4:b0ce6385d008 | 530 | else ADXL372.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 531 | // ---------------- End of writing cycle --------------------------// |
| SDesign2018 | 4:b0ce6385d008 | 532 | |
| SDesign2018 | 4:b0ce6385d008 | 533 | //--------- One full writing cycle for ADXL372 for Z Enable ------------------// |
| SDesign2018 | 4:b0ce6385d008 | 534 | /* '0' - NAK was received |
| SDesign2018 | 4:b0ce6385d008 | 535 | * '1' - ACK was received, <---- This good |
| SDesign2018 | 4:b0ce6385d008 | 536 | * '2' - timeout |
| SDesign2018 | 4:b0ce6385d008 | 537 | */ |
| SDesign2018 | 4:b0ce6385d008 | 538 | ADXL372.start(); |
| SDesign2018 | 4:b0ce6385d008 | 539 | flag = ADXL372.write(ADXL372_Address_8bit); |
| SDesign2018 | 4:b0ce6385d008 | 540 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 541 | { |
| SDesign2018 | 4:b0ce6385d008 | 542 | pc.printf("Write to I2C address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 543 | wait(0.1); |
| SDesign2018 | 4:b0ce6385d008 | 544 | flag = ADXL372.write(0x26); |
| SDesign2018 | 4:b0ce6385d008 | 545 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 546 | { |
| SDesign2018 | 4:b0ce6385d008 | 547 | pc.printf("Write to 0x26 register address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 548 | flag = ADXL372.write(0x01); // Set bit 0 |
| SDesign2018 | 4:b0ce6385d008 | 549 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 550 | { |
| SDesign2018 | 4:b0ce6385d008 | 551 | pc.printf("Write data to register address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 552 | pc.printf("Z Enable should be set now\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 553 | |
| SDesign2018 | 4:b0ce6385d008 | 554 | ADXL372.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 555 | } |
| SDesign2018 | 4:b0ce6385d008 | 556 | } |
| SDesign2018 | 4:b0ce6385d008 | 557 | } |
| SDesign2018 | 4:b0ce6385d008 | 558 | else ADXL372.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 559 | // ---------------- End of writing cycle --------------------------// |
| SDesign2018 | 4:b0ce6385d008 | 560 | |
| SDesign2018 | 4:b0ce6385d008 | 561 | } |
| SDesign2018 | 4:b0ce6385d008 | 562 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 563 | |
| SDesign2018 | 4:b0ce6385d008 | 564 | |
| SDesign2018 | 4:b0ce6385d008 | 565 | |
| SDesign2018 | 4:b0ce6385d008 | 566 | /******************************************************************************* |
| SDesign2018 | 4:b0ce6385d008 | 567 | * BitBangSPIWrite for ADXL372 if you wire it up as SPI |
| SDesign2018 | 4:b0ce6385d008 | 568 | * |
| SDesign2018 | 4:b0ce6385d008 | 569 | * Sends the 6-0bits of desired register with LSB of transmission bit R/!W |
| SDesign2018 | 4:b0ce6385d008 | 570 | * |
| SDesign2018 | 4:b0ce6385d008 | 571 | ******************************************************************************/ |
| SDesign2018 | 4:b0ce6385d008 | 572 | /////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 573 | void BitBangSPIWrite(const unsigned char regAddr, const unsigned char regData) |
| SDesign2018 | 4:b0ce6385d008 | 574 | { |
| SDesign2018 | 4:b0ce6385d008 | 575 | unsigned char SPICount; // Counter used to clock out the data |
| SDesign2018 | 4:b0ce6385d008 | 576 | |
| SDesign2018 | 4:b0ce6385d008 | 577 | unsigned char SPIData; // Define a data structure for the SPI data |
| SDesign2018 | 4:b0ce6385d008 | 578 | SPI_CS = 0; // Make sure we start with active-low CS high |
| SDesign2018 | 4:b0ce6385d008 | 579 | SPI_CLK = 0; // and CK low |
| SDesign2018 | 4:b0ce6385d008 | 580 | |
| SDesign2018 | 4:b0ce6385d008 | 581 | SPIData = regAddr; // Preload the data to be sent with Address |
| SDesign2018 | 4:b0ce6385d008 | 582 | SPI_CS = 1; // Set active-low CS low to start the SPI cycle |
| SDesign2018 | 4:b0ce6385d008 | 583 | |
| SDesign2018 | 4:b0ce6385d008 | 584 | for (SPICount = 0; SPICount < 8; SPICount++) // Prepare to clock out the Address byte |
| SDesign2018 | 4:b0ce6385d008 | 585 | { |
| SDesign2018 | 4:b0ce6385d008 | 586 | if (SPIData & 0x80) // Check for a 1 at MSB |
| SDesign2018 | 4:b0ce6385d008 | 587 | MOSI = 1; // and set the MOSI line appropriately |
| SDesign2018 | 4:b0ce6385d008 | 588 | else |
| SDesign2018 | 4:b0ce6385d008 | 589 | MOSI = 0; |
| SDesign2018 | 4:b0ce6385d008 | 590 | SPI_CLK = 1; // Toggle the clock line |
| SDesign2018 | 4:b0ce6385d008 | 591 | SPI_CLK = 0; |
| SDesign2018 | 4:b0ce6385d008 | 592 | SPIData <<= 1; // Rotate to get the next bit |
| SDesign2018 | 4:b0ce6385d008 | 593 | } // and loop back to send the next bit |
| SDesign2018 | 4:b0ce6385d008 | 594 | |
| SDesign2018 | 4:b0ce6385d008 | 595 | // Repeat for the Data byte |
| SDesign2018 | 4:b0ce6385d008 | 596 | SPIData = regData; // Preload the data to be sent with Data |
| SDesign2018 | 4:b0ce6385d008 | 597 | for (SPICount = 0; SPICount < 8; SPICount++) |
| SDesign2018 | 4:b0ce6385d008 | 598 | { |
| SDesign2018 | 4:b0ce6385d008 | 599 | if (SPIData & 0x80) |
| SDesign2018 | 4:b0ce6385d008 | 600 | MOSI = 1; |
| SDesign2018 | 4:b0ce6385d008 | 601 | else |
| SDesign2018 | 4:b0ce6385d008 | 602 | MOSI = 0; |
| SDesign2018 | 4:b0ce6385d008 | 603 | SPI_CLK = 1; |
| SDesign2018 | 4:b0ce6385d008 | 604 | SPI_CLK = 0; |
| SDesign2018 | 4:b0ce6385d008 | 605 | SPIData <<= 1; // After each bit, move next bit one to left |
| SDesign2018 | 4:b0ce6385d008 | 606 | } |
| SDesign2018 | 4:b0ce6385d008 | 607 | SPI_CS = 0; |
| SDesign2018 | 4:b0ce6385d008 | 608 | MOSI = 0; |
| SDesign2018 | 4:b0ce6385d008 | 609 | } |
| SDesign2018 | 4:b0ce6385d008 | 610 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 611 | |
| SDesign2018 | 4:b0ce6385d008 | 612 | |
| SDesign2018 | 4:b0ce6385d008 | 613 | |
| SDesign2018 | 4:b0ce6385d008 | 614 | /******************************************************************************* |
| SDesign2018 | 4:b0ce6385d008 | 615 | * BitBangSPIRead for ADXL372 if you wire it up as SPI |
| SDesign2018 | 4:b0ce6385d008 | 616 | * |
| SDesign2018 | 4:b0ce6385d008 | 617 | * |
| SDesign2018 | 4:b0ce6385d008 | 618 | * |
| SDesign2018 | 4:b0ce6385d008 | 619 | ******************************************************************************/ |
| SDesign2018 | 4:b0ce6385d008 | 620 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 621 | unsigned char BitBangSPIRead (const unsigned char regAddr) |
| SDesign2018 | 4:b0ce6385d008 | 622 | { |
| SDesign2018 | 4:b0ce6385d008 | 623 | |
| SDesign2018 | 4:b0ce6385d008 | 624 | unsigned char SPICount; // Counter used to clock out the data |
| SDesign2018 | 4:b0ce6385d008 | 625 | |
| SDesign2018 | 4:b0ce6385d008 | 626 | unsigned char SPIData; |
| SDesign2018 | 4:b0ce6385d008 | 627 | |
| SDesign2018 | 4:b0ce6385d008 | 628 | SPI_CS = 0; // Make sure we start with active-low CS high |
| SDesign2018 | 4:b0ce6385d008 | 629 | SPI_CLK = 0; // and CK low |
| SDesign2018 | 4:b0ce6385d008 | 630 | SPIData = regAddr; // Preload the data to be sent with Address and Data |
| SDesign2018 | 4:b0ce6385d008 | 631 | |
| SDesign2018 | 4:b0ce6385d008 | 632 | SPI_CS = 1; // Set active-low CS low to start the SPI cycle |
| SDesign2018 | 4:b0ce6385d008 | 633 | for (SPICount = 0; SPICount < 8; SPICount++) // Prepare to clock out the Address and Data |
| SDesign2018 | 4:b0ce6385d008 | 634 | { |
| SDesign2018 | 4:b0ce6385d008 | 635 | if (SPIData & 0x80) |
| SDesign2018 | 4:b0ce6385d008 | 636 | MOSI = 1; |
| SDesign2018 | 4:b0ce6385d008 | 637 | else |
| SDesign2018 | 4:b0ce6385d008 | 638 | MOSI = 0; |
| SDesign2018 | 4:b0ce6385d008 | 639 | SPI_CLK = 1; |
| SDesign2018 | 4:b0ce6385d008 | 640 | SPI_CLK = 0; |
| SDesign2018 | 4:b0ce6385d008 | 641 | SPIData <<= 1; |
| SDesign2018 | 4:b0ce6385d008 | 642 | }// and loop back to send the next bit |
| SDesign2018 | 4:b0ce6385d008 | 643 | |
| SDesign2018 | 4:b0ce6385d008 | 644 | MOSI = 0; // Reset the MOSI data line |
| SDesign2018 | 4:b0ce6385d008 | 645 | |
| SDesign2018 | 4:b0ce6385d008 | 646 | SPIData = 0; |
| SDesign2018 | 4:b0ce6385d008 | 647 | for (SPICount = 0; SPICount < 8; SPICount++) // Prepare to clock in the data to be read |
| SDesign2018 | 4:b0ce6385d008 | 648 | { |
| SDesign2018 | 4:b0ce6385d008 | 649 | SPIData <<=1; // Rotate the data, keep previous bit value |
| SDesign2018 | 4:b0ce6385d008 | 650 | SPI_CLK = 1; // Raise the clock to clock the data out of the MAX7456 |
| SDesign2018 | 4:b0ce6385d008 | 651 | SPIData += SPI_MISO; // Read the data one bit at a time, starting from MISO MSB |
| SDesign2018 | 4:b0ce6385d008 | 652 | SPI_CLK = 0; // Drop the clock ready for the next bit |
| SDesign2018 | 4:b0ce6385d008 | 653 | }// and loop back for next bit |
| SDesign2018 | 4:b0ce6385d008 | 654 | SPI_CS = 0; // Raise CS |
| SDesign2018 | 4:b0ce6385d008 | 655 | |
| SDesign2018 | 4:b0ce6385d008 | 656 | return ((unsigned char)SPIData); // Finally return the read data |
| SDesign2018 | 4:b0ce6385d008 | 657 | } |
| SDesign2018 | 4:b0ce6385d008 | 658 | |
| SDesign2018 | 4:b0ce6385d008 | 659 | /******************************************************************************* |
| SDesign2018 | 4:b0ce6385d008 | 660 | * Not really used at the moment |
| SDesign2018 | 4:b0ce6385d008 | 661 | * Not really needed. But keep just in case because I don't want to rewrite it |
| SDesign2018 | 4:b0ce6385d008 | 662 | ******************************************************************************/ |
| SDesign2018 | 4:b0ce6385d008 | 663 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 664 | unsigned char twosComplementConversion(unsigned char value) |
| SDesign2018 | 4:b0ce6385d008 | 665 | { |
| SDesign2018 | 4:b0ce6385d008 | 666 | /* |
| SDesign2018 | 4:b0ce6385d008 | 667 | * Go from bit 0 to bit 7 and invert them |
| SDesign2018 | 4:b0ce6385d008 | 668 | * Then finally add 1 |
| SDesign2018 | 4:b0ce6385d008 | 669 | */ |
| SDesign2018 | 4:b0ce6385d008 | 670 | char mask = value & 0x80; |
| SDesign2018 | 4:b0ce6385d008 | 671 | if(mask == 0x80){ // Check for sign |
| SDesign2018 | 4:b0ce6385d008 | 672 | value = ~value + 1; |
| SDesign2018 | 4:b0ce6385d008 | 673 | return value; |
| SDesign2018 | 4:b0ce6385d008 | 674 | } |
| SDesign2018 | 4:b0ce6385d008 | 675 | return value; |
| SDesign2018 | 4:b0ce6385d008 | 676 | } |
| SDesign2018 | 4:b0ce6385d008 | 677 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 678 | |
| SDesign2018 | 4:b0ce6385d008 | 679 | |
| SDesign2018 | 4:b0ce6385d008 | 680 | /******************************************************************************* |
| SDesign2018 | 4:b0ce6385d008 | 681 | * Performs one byte write I2C protocol |
| SDesign2018 | 4:b0ce6385d008 | 682 | * PARAM: |
| SDesign2018 | 4:b0ce6385d008 | 683 | * registerAddress: register you want access to in device, one byte char hex format |
| SDesign2018 | 4:b0ce6385d008 | 684 | * data: one byte data that you want to write to device register |
| SDesign2018 | 4:b0ce6385d008 | 685 | * Return: |
| SDesign2018 | 4:b0ce6385d008 | 686 | * 0: failure at writing i2c address |
| SDesign2018 | 4:b0ce6385d008 | 687 | * 1: successful write |
| SDesign2018 | 4:b0ce6385d008 | 688 | * 2: failure at writing data |
| SDesign2018 | 4:b0ce6385d008 | 689 | * 3: failure at writing register address |
| SDesign2018 | 4:b0ce6385d008 | 690 | ******************************************************************************/ |
| SDesign2018 | 4:b0ce6385d008 | 691 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 692 | int ADT7410Write(unsigned char registerAddress, unsigned char data){ |
| SDesign2018 | 4:b0ce6385d008 | 693 | int flag; |
| SDesign2018 | 4:b0ce6385d008 | 694 | ADT7410.start(); |
| SDesign2018 | 4:b0ce6385d008 | 695 | flag = ADT7410.write(ADT7410_Address_8BIT); |
| SDesign2018 | 4:b0ce6385d008 | 696 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 697 | { |
| SDesign2018 | 4:b0ce6385d008 | 698 | pc.printf("Write to I2C address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 699 | wait(0.1); |
| SDesign2018 | 4:b0ce6385d008 | 700 | flag = ADT7410.write(registerAddress); |
| SDesign2018 | 4:b0ce6385d008 | 701 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 702 | { |
| SDesign2018 | 4:b0ce6385d008 | 703 | pc.printf("Write to register 0x%x address success\n\r", registerAddress); |
| SDesign2018 | 4:b0ce6385d008 | 704 | flag = ADT7410.write(data); |
| SDesign2018 | 4:b0ce6385d008 | 705 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 706 | { |
| SDesign2018 | 4:b0ce6385d008 | 707 | pc.printf("Writing data 0x%x to register address success\n\r", data); |
| SDesign2018 | 4:b0ce6385d008 | 708 | ADT7410.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 709 | return 1; |
| SDesign2018 | 4:b0ce6385d008 | 710 | }else {ADT7410.stop(); return 2;} |
| SDesign2018 | 4:b0ce6385d008 | 711 | }else {ADT7410.stop(); return 3;} |
| SDesign2018 | 4:b0ce6385d008 | 712 | }else ADT7410.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 713 | |
| SDesign2018 | 4:b0ce6385d008 | 714 | return 0; |
| SDesign2018 | 4:b0ce6385d008 | 715 | } |
| SDesign2018 | 4:b0ce6385d008 | 716 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 717 | |
| SDesign2018 | 4:b0ce6385d008 | 718 | /******************************************************************************* |
| SDesign2018 | 4:b0ce6385d008 | 719 | * I2C Read function for ADT7410 Temperature sensor |
| SDesign2018 | 4:b0ce6385d008 | 720 | * Param: |
| SDesign2018 | 4:b0ce6385d008 | 721 | * hex: hexadecimal representation for desired register |
| SDesign2018 | 4:b0ce6385d008 | 722 | * Return: |
| SDesign2018 | 4:b0ce6385d008 | 723 | * Char pointer to the array of data values. |
| SDesign2018 | 4:b0ce6385d008 | 724 | * Could also change from a char pointer to a uint8_t pointer. |
| SDesign2018 | 4:b0ce6385d008 | 725 | * |
| SDesign2018 | 4:b0ce6385d008 | 726 | ******************************************************************************/ |
| SDesign2018 | 4:b0ce6385d008 | 727 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 728 | char * ADT7410Read(int hex){ |
| SDesign2018 | 4:b0ce6385d008 | 729 | //short int convertedVal; |
| SDesign2018 | 4:b0ce6385d008 | 730 | char data[2] = {0, 0}; |
| SDesign2018 | 4:b0ce6385d008 | 731 | char cmd[1]; |
| SDesign2018 | 4:b0ce6385d008 | 732 | cmd[0] = hex; |
| SDesign2018 | 4:b0ce6385d008 | 733 | //pc.printf("Register Addres is: %x \n\r", cmd[0]); |
| SDesign2018 | 4:b0ce6385d008 | 734 | if(ADT7410.write(ADT7410_Address_8BIT, cmd,1) == 0){ |
| SDesign2018 | 4:b0ce6385d008 | 735 | if(ADT7410.read(ADT7410_Address_8BIT, data, 2) == 0){ |
| SDesign2018 | 4:b0ce6385d008 | 736 | |
| SDesign2018 | 4:b0ce6385d008 | 737 | return data; |
| SDesign2018 | 4:b0ce6385d008 | 738 | //return (data[0] << 8 | data[1])>>3; // Explained here: https://stackoverflow.com/a/141576 SOOO GREAT |
| SDesign2018 | 4:b0ce6385d008 | 739 | |
| SDesign2018 | 4:b0ce6385d008 | 740 | }else {pc.printf("Failed to read \n\r"); return data;} |
| SDesign2018 | 4:b0ce6385d008 | 741 | }else {pc.printf("Failed to write \n\r"); return data;} |
| SDesign2018 | 4:b0ce6385d008 | 742 | |
| SDesign2018 | 4:b0ce6385d008 | 743 | } |
| SDesign2018 | 4:b0ce6385d008 | 744 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 745 | |
| SDesign2018 | 4:b0ce6385d008 | 746 | |
| SDesign2018 | 4:b0ce6385d008 | 747 | /******************************************************************************* |
| SDesign2018 | 4:b0ce6385d008 | 748 | * ADXL372 reset function |
| SDesign2018 | 4:b0ce6385d008 | 749 | * Resets all registers and settings back to default |
| SDesign2018 | 4:b0ce6385d008 | 750 | * Basically the same as the previous ADXL372 I2C write function |
| SDesign2018 | 4:b0ce6385d008 | 751 | * |
| SDesign2018 | 4:b0ce6385d008 | 752 | ******************************************************************************/ |
| SDesign2018 | 4:b0ce6385d008 | 753 | //////////////////////////////////////////////////////////////////////////////// |
| SDesign2018 | 4:b0ce6385d008 | 754 | void ADXL372Reset(void){ |
| SDesign2018 | 4:b0ce6385d008 | 755 | int flag; |
| SDesign2018 | 4:b0ce6385d008 | 756 | //--------- One full writing cycle for ADXL372 for Z Enable ------------------// |
| SDesign2018 | 4:b0ce6385d008 | 757 | /* '0' - NAK was received |
| SDesign2018 | 4:b0ce6385d008 | 758 | * '1' - ACK was received, <---- This good |
| SDesign2018 | 4:b0ce6385d008 | 759 | * '2' - timeout |
| SDesign2018 | 4:b0ce6385d008 | 760 | */ |
| SDesign2018 | 4:b0ce6385d008 | 761 | ADXL372.start(); |
| SDesign2018 | 4:b0ce6385d008 | 762 | flag = ADXL372.write(ADXL372_Address_8bit | 0); |
| SDesign2018 | 4:b0ce6385d008 | 763 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 764 | { |
| SDesign2018 | 4:b0ce6385d008 | 765 | //pc.printf("Write to I2C address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 766 | |
| SDesign2018 | 4:b0ce6385d008 | 767 | flag = ADXL372.write(0x41); |
| SDesign2018 | 4:b0ce6385d008 | 768 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 769 | { |
| SDesign2018 | 4:b0ce6385d008 | 770 | //pc.printf("Write to 0x41 register address success\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 771 | flag = ADXL372.write(0x52); // Set bit 0 |
| SDesign2018 | 4:b0ce6385d008 | 772 | if(flag == 1) |
| SDesign2018 | 4:b0ce6385d008 | 773 | { |
| SDesign2018 | 4:b0ce6385d008 | 774 | pc.printf("Everything has been reset\n\r"); |
| SDesign2018 | 4:b0ce6385d008 | 775 | ADXL372.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 776 | } |
| SDesign2018 | 4:b0ce6385d008 | 777 | } |
| SDesign2018 | 4:b0ce6385d008 | 778 | } |
| SDesign2018 | 4:b0ce6385d008 | 779 | else ADXL372.stop(); |
| SDesign2018 | 4:b0ce6385d008 | 780 | // ---------------- End of writing cycle --------------------------// |
| SDesign2018 | 4:b0ce6385d008 | 781 | } |
| SDesign2018 | 4:b0ce6385d008 | 782 | //////////////////////////////////////////////////////////////////////////////// |