Yann Garcia / FM24Vxx_I2C

Simplified access to Ramtron (Cypress) FM24Vxx F-RAM devices

Dependents:   FM24Vxx_I2CApp

FM24Vxx_I2C.cpp@0:fa858f79d48d, 2013-03-23 (annotated)

Committer:
Yann
Date:
Sat Mar 23 15:54:01 2013 +0000
Revision:
0:fa858f79d48d
Child:
1:6a16bddd7222
Create library interface for FM24V10 1Mb Serial 3V F-RAM Memory (Requested by M. Reed Kimble)

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Yann 0:fa858f79d48d 1 /* mbed simplified access to RAMTRON FV24xx Serial 3V F-RAM Memory (I2C)
Yann 0:fa858f79d48d 2 * Copyright (c) 20103 ygarcia, MIT License
Yann 0:fa858f79d48d 3 *
Yann 0:fa858f79d48d 4 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
Yann 0:fa858f79d48d 5 * and associated documentation files (the "Software"), to deal in the Software without restriction,
Yann 0:fa858f79d48d 6 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
Yann 0:fa858f79d48d 7 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
Yann 0:fa858f79d48d 8 * furnished to do so, subject to the following conditions:
Yann 0:fa858f79d48d 9 *
Yann 0:fa858f79d48d 10 * The above copyright notice and this permission notice shall be included in all copies or
Yann 0:fa858f79d48d 11 * substantial portions of the Software.
Yann 0:fa858f79d48d 12 *
Yann 0:fa858f79d48d 13 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
Yann 0:fa858f79d48d 14 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
Yann 0:fa858f79d48d 15 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
Yann 0:fa858f79d48d 16 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
Yann 0:fa858f79d48d 17 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
Yann 0:fa858f79d48d 18 */
Yann 0:fa858f79d48d 19 #include <iostream>
Yann 0:fa858f79d48d 20 #include <sstream>
Yann 0:fa858f79d48d 21
Yann 0:fa858f79d48d 22 #include "FM24Vxx_I2C.h"
Yann 0:fa858f79d48d 23
Yann 0:fa858f79d48d 24 namespace _FM24VXX_I2C {
Yann 0:fa858f79d48d 25
Yann 0:fa858f79d48d 26 unsigned char CFM24VXX_I2C::I2CModuleRefCounter = 0;
Yann 0:fa858f79d48d 27
Yann 0:fa858f79d48d 28 CFM24VXX_I2C::CFM24VXX_I2C(const PinName p_sda, const PinName p_scl, const unsigned char p_address, const PinName p_wp, const unsigned int p_frequency) : _internalId("") {
Yann 0:fa858f79d48d 29 DEBUG_ENTER("CFM24VXX_I2C")
Yann 0:fa858f79d48d 30
Yann 0:fa858f79d48d 31 if (CFM24VXX_I2C::I2CModuleRefCounter != 0) {
Yann 0:fa858f79d48d 32 error("CFM24VXX_I2C: Wrong params");
Yann 0:fa858f79d48d 33 }
Yann 0:fa858f79d48d 34 #ifdef __DEBUG
Yann 0:fa858f79d48d 35 std::ostringstream out(std::ostringstream::out);
Yann 0:fa858f79d48d 36 out << "CFM24VXX_I2C #" << CFM24VXX_I2C::I2CModuleRefCounter;
Yann 0:fa858f79d48d 37 _internalId.assign(out.str());
Yann 0:fa858f79d48d 38 DEBUG("CFM24VXX_I2C: _internalId='%s'", _internalId.c_str())
Yann 0:fa858f79d48d 39 #endif // __DEBUG
Yann 0:fa858f79d48d 40 _i2cInstance = new I2C(p_sda, p_scl);
Yann 0:fa858f79d48d 41 CFM24VXX_I2C::I2CModuleRefCounter += 1;
Yann 0:fa858f79d48d 42 DEBUG_ENTER("CFM24VXX_I2C: refCounter=%d", CFM24VXX_I2C::I2CModuleRefCounter)
Yann 0:fa858f79d48d 43 // Memory page select is set to 0
Yann 0:fa858f79d48d 44 _slaveAddress = (p_address << 2) | 0xa0; // Slave address format is: 1 0 1 0 A2 A1 PS R/W, PS set to 0
Yann 0:fa858f79d48d 45 DEBUG("CFM24VXX_I2C: I2C slave adress: 0x%02x", _slaveAddress)
Yann 0:fa858f79d48d 46 _i2cInstance->frequency(p_frequency); // Set the frequency of the I2C interface
Yann 0:fa858f79d48d 47
Yann 0:fa858f79d48d 48 if (p_wp != NC) {
Yann 0:fa858f79d48d 49 DEBUG("CFM24VXX_I2C: WP managed");
Yann 0:fa858f79d48d 50 _wp = new DigitalOut(p_wp);
Yann 0:fa858f79d48d 51 _wp->write(0); // Disable write protect
Yann 0:fa858f79d48d 52 } else {
Yann 0:fa858f79d48d 53 DEBUG("CFM24VXX_I2C: WP not managed");
Yann 0:fa858f79d48d 54 _wp = NULL; // Not used
Yann 0:fa858f79d48d 55 }
Yann 0:fa858f79d48d 56
Yann 0:fa858f79d48d 57 // Retrieve device identifiers
Yann 0:fa858f79d48d 58 _deviceID = NULL;
Yann 0:fa858f79d48d 59 GetDevideIDs();
Yann 0:fa858f79d48d 60
Yann 0:fa858f79d48d 61 DEBUG_LEAVE("CFM24VXX_I2C")
Yann 0:fa858f79d48d 62 }
Yann 0:fa858f79d48d 63
Yann 0:fa858f79d48d 64 CFM24VXX_I2C::~CFM24VXX_I2C() {
Yann 0:fa858f79d48d 65 DEBUG_ENTER("~CFM24VXX_I2C")
Yann 0:fa858f79d48d 66
Yann 0:fa858f79d48d 67 // Release I2C instance
Yann 0:fa858f79d48d 68 DEBUG_ENTER("~CFM24VXX_I2C: refCounter=%d", CFM24VXX_I2C::I2CModuleRefCounter)
Yann 0:fa858f79d48d 69 CFM24VXX_I2C::I2CModuleRefCounter -= 1;
Yann 0:fa858f79d48d 70 if (CFM24VXX_I2C::I2CModuleRefCounter == 0) {
Yann 0:fa858f79d48d 71 delete _i2cInstance;
Yann 0:fa858f79d48d 72 _i2cInstance = NULL;
Yann 0:fa858f79d48d 73 if (_deviceID != NULL) {
Yann 0:fa858f79d48d 74 delete _deviceID;
Yann 0:fa858f79d48d 75 _deviceID = NULL;
Yann 0:fa858f79d48d 76 }
Yann 0:fa858f79d48d 77 }
Yann 0:fa858f79d48d 78 // Release _wp if required
Yann 0:fa858f79d48d 79 if (_wp != NULL) {
Yann 0:fa858f79d48d 80 _wp->write(0);
Yann 0:fa858f79d48d 81 delete _wp;
Yann 0:fa858f79d48d 82 }
Yann 0:fa858f79d48d 83
Yann 0:fa858f79d48d 84 DEBUG_LEAVE("~CFM24VXX_I2C")
Yann 0:fa858f79d48d 85 }
Yann 0:fa858f79d48d 86
Yann 0:fa858f79d48d 87 bool CFM24VXX_I2C::WriteProtect(const bool p_writeProtect) {
Yann 0:fa858f79d48d 88 if (_wp != NULL) {
Yann 0:fa858f79d48d 89 DEBUG("WP set to: %x", (int)p_writeProtect)
Yann 0:fa858f79d48d 90 _wp->write((int)(p_writeProtect));
Yann 0:fa858f79d48d 91 return true;
Yann 0:fa858f79d48d 92 }
Yann 0:fa858f79d48d 93
Yann 0:fa858f79d48d 94 return false;
Yann 0:fa858f79d48d 95 }
Yann 0:fa858f79d48d 96
Yann 0:fa858f79d48d 97 void CFM24VXX_I2C::GetDevideIDs() {
Yann 0:fa858f79d48d 98 _deviceID = new CFM24VXX_IDs(0x00, 0x00, 0x00);
Yann 0:fa858f79d48d 99 }
Yann 0:fa858f79d48d 100
Yann 0:fa858f79d48d 101 bool CFM24VXX_I2C::EraseMemoryArea(const short p_startAddress, const int p_count, const unsigned char p_pattern) {
Yann 0:fa858f79d48d 102 DEBUG_ENTER("CFM24VXX_I2C::EraseMemoryArea: 0x%02x - %d - 0x%02x", p_startAddress, p_count, p_pattern)
Yann 0:fa858f79d48d 103
Yann 0:fa858f79d48d 104 std::vector<unsigned char> eraseBuffer(p_count, p_pattern);
Yann 0:fa858f79d48d 105 return Write(p_startAddress, eraseBuffer, false);
Yann 0:fa858f79d48d 106 }
Yann 0:fa858f79d48d 107
Yann 0:fa858f79d48d 108 bool CFM24VXX_I2C::Write(const short p_address, const unsigned char p_byte) {
Yann 0:fa858f79d48d 109 DEBUG_ENTER("CFM24VXX_I2C::Write (byte): Memory address: 0x%02x - 0x%02x", p_address, p_byte)
Yann 0:fa858f79d48d 110
Yann 0:fa858f79d48d 111 // 1.Prepare buffer
Yann 0:fa858f79d48d 112 char i2cBuffer[3]; // Memory address + one byte of data
Yann 0:fa858f79d48d 113 // 1.1. Memory address
Yann 0:fa858f79d48d 114 short address = p_address + 1; // Index start to 1
Yann 0:fa858f79d48d 115 i2cBuffer[0] = (unsigned char)(address >> 8);
Yann 0:fa858f79d48d 116 DEBUG("CFM24VXX_I2C::Write (byte): pI2CBuffer[0]: 0x%02x", i2cBuffer[0])
Yann 0:fa858f79d48d 117 i2cBuffer[1] = (unsigned char)((unsigned char)address & 0xff);
Yann 0:fa858f79d48d 118 DEBUG("CFM24VXX_I2C::Write (byte): pI2CBuffer[1]: 0x%02x", i2cBuffer[1])
Yann 0:fa858f79d48d 119 // 1.2. Datas
Yann 0:fa858f79d48d 120 i2cBuffer[2] = p_byte;
Yann 0:fa858f79d48d 121 DEBUG("CFM24VXX_I2C::Write (byte): value=0x%02x", i2cBuffer[2])
Yann 0:fa858f79d48d 122
Yann 0:fa858f79d48d 123 // 2. Send I2C start + I2C address + Memory Address + Datas + I2C stop
Yann 0:fa858f79d48d 124 int result = _i2cInstance->write(_slaveAddress, i2cBuffer, 3);
Yann 0:fa858f79d48d 125 wait(0.02);
Yann 0:fa858f79d48d 126
Yann 0:fa858f79d48d 127 DEBUG_LEAVE("CFM24VXX_I2C::Write (byte) %x", (bool)(result == 0))
Yann 0:fa858f79d48d 128 return (bool)(result == 0);
Yann 0:fa858f79d48d 129 }
Yann 0:fa858f79d48d 130
Yann 0:fa858f79d48d 131 bool CFM24VXX_I2C::Write(const short p_address, const short p_short, const CFM24VXX_I2C::Mode p_mode) {
Yann 0:fa858f79d48d 132 DEBUG_ENTER("CFM24VXX_I2C::Write (short): Memory address:0x%02x, Mode:%d", p_address, p_mode)
Yann 0:fa858f79d48d 133
Yann 0:fa858f79d48d 134 // 1.Prepare buffer
Yann 0:fa858f79d48d 135 char i2cBuffer[4]; // Memory address + one short (2 bytes)
Yann 0:fa858f79d48d 136 // 1.1. Memory address
Yann 0:fa858f79d48d 137 short address = p_address + 1; // Index start to 1
Yann 0:fa858f79d48d 138 i2cBuffer[0] = (unsigned char)(address >> 8);
Yann 0:fa858f79d48d 139 DEBUG("CFM24VXX_I2C::Write (short): pI2CBuffer[0]: 0x%02x", i2cBuffer[0])
Yann 0:fa858f79d48d 140 i2cBuffer[1] = (unsigned char)((unsigned char)address & 0xff);
Yann 0:fa858f79d48d 141 DEBUG("CFM24VXX_I2C::Write (short): pI2CBuffer[1]: 0x%02x", i2cBuffer[1])
Yann 0:fa858f79d48d 142 // 1.2. Datas
Yann 0:fa858f79d48d 143 if (p_mode == BigEndian) {
Yann 0:fa858f79d48d 144 i2cBuffer[2] = (unsigned char)(p_short >> 8);
Yann 0:fa858f79d48d 145 i2cBuffer[3] = (unsigned char)((unsigned char)p_short & 0xff);
Yann 0:fa858f79d48d 146 } else {
Yann 0:fa858f79d48d 147 i2cBuffer[2] = (unsigned char)((unsigned char)p_short & 0xff);
Yann 0:fa858f79d48d 148 i2cBuffer[3] = (unsigned char)(p_short >> 8);
Yann 0:fa858f79d48d 149 }
Yann 0:fa858f79d48d 150 DEBUG("CFM24VXX_I2C::Write (short): value=0x%02x%02x", i2cBuffer[2], i2cBuffer[3])
Yann 0:fa858f79d48d 151
Yann 0:fa858f79d48d 152 // 2. Send I2C start + I2C address + Memory Address + Datas + I2C stop
Yann 0:fa858f79d48d 153 int result = _i2cInstance->write(_slaveAddress, i2cBuffer, 4);
Yann 0:fa858f79d48d 154 wait(0.02);
Yann 0:fa858f79d48d 155
Yann 0:fa858f79d48d 156 DEBUG_LEAVE("CFM24VXX_I2C::Write (short) %x", (bool)(result == 0))
Yann 0:fa858f79d48d 157 return (bool)(result == 0);
Yann 0:fa858f79d48d 158 }
Yann 0:fa858f79d48d 159
Yann 0:fa858f79d48d 160 bool CFM24VXX_I2C::Write(const short p_address, const int p_int, const CFM24VXX_I2C::Mode p_mode) {
Yann 0:fa858f79d48d 161 DEBUG_ENTER("CFM24VXX_I2C::Write (int): Memory address:0x%02x, Mode:%d", p_address, p_mode)
Yann 0:fa858f79d48d 162
Yann 0:fa858f79d48d 163 // 1.Prepare buffer
Yann 0:fa858f79d48d 164 char i2cBuffer[6]; // Memory address + one integer (4 bytes)
Yann 0:fa858f79d48d 165 // 1.1. Memory address
Yann 0:fa858f79d48d 166 short address = p_address + 1; // Index start to 1
Yann 0:fa858f79d48d 167 i2cBuffer[0] = (unsigned char)(address >> 8);
Yann 0:fa858f79d48d 168 DEBUG("CFM24VXX_I2C::Write (int): pI2CBuffer[0]: 0x%02x", i2cBuffer[0])
Yann 0:fa858f79d48d 169 i2cBuffer[1] = (unsigned char)((unsigned char)address & 0xff);
Yann 0:fa858f79d48d 170 DEBUG("CFM24VXX_I2C::Write (int): pI2CBuffer[1]: 0x%02x", i2cBuffer[1])
Yann 0:fa858f79d48d 171 // 1.2. Datas
Yann 0:fa858f79d48d 172 if (p_mode == BigEndian) {
Yann 0:fa858f79d48d 173 i2cBuffer[2] = (unsigned char)(p_int >> 24);
Yann 0:fa858f79d48d 174 i2cBuffer[3] = (unsigned char)(p_int >> 16);
Yann 0:fa858f79d48d 175 i2cBuffer[4] = (unsigned char)(p_int >> 8);
Yann 0:fa858f79d48d 176 i2cBuffer[5] = (unsigned char)((unsigned char)p_int & 0xff);
Yann 0:fa858f79d48d 177 } else {
Yann 0:fa858f79d48d 178 i2cBuffer[2] = (unsigned char)((unsigned char)p_int & 0xff);
Yann 0:fa858f79d48d 179 i2cBuffer[3] = (unsigned char)(p_int >> 8);
Yann 0:fa858f79d48d 180 i2cBuffer[4] = (unsigned char)(p_int >> 16);
Yann 0:fa858f79d48d 181 i2cBuffer[5] = (unsigned char)(p_int >> 24);
Yann 0:fa858f79d48d 182 }
Yann 0:fa858f79d48d 183 DEBUG("CFM24VXX_I2C::Write (int): value=0x%02x%02x%02x%02x", i2cBuffer[2], i2cBuffer[3], i2cBuffer[4], i2cBuffer[5])
Yann 0:fa858f79d48d 184
Yann 0:fa858f79d48d 185 // 2. Send I2C start + I2C address + Memory Address + Datas + I2C stop
Yann 0:fa858f79d48d 186 int result = _i2cInstance->write(_slaveAddress, i2cBuffer, 6);
Yann 0:fa858f79d48d 187 wait(0.02);
Yann 0:fa858f79d48d 188
Yann 0:fa858f79d48d 189 DEBUG_LEAVE("CFM24VXX_I2C::Write (int) %x", (bool)(result == 0))
Yann 0:fa858f79d48d 190 return (bool)(result == 0);
Yann 0:fa858f79d48d 191 }
Yann 0:fa858f79d48d 192
Yann 0:fa858f79d48d 193 bool CFM24VXX_I2C::Write(const short p_address, const std::string & p_string, const bool p_storeLength, const int p_length2write) {
Yann 0:fa858f79d48d 194 DEBUG_ENTER("CFM24VXX_I2C::Write (std::string)")
Yann 0:fa858f79d48d 195 return Write(p_address, p_string.c_str(), p_storeLength, p_length2write);
Yann 0:fa858f79d48d 196 }
Yann 0:fa858f79d48d 197
Yann 0:fa858f79d48d 198 bool CFM24VXX_I2C::Write(const short p_address, const std::vector<unsigned char> & p_datas, const bool p_storeLength, const int p_length2write) {
Yann 0:fa858f79d48d 199 DEBUG_ENTER("CFM24VXX_I2C::Write (std::vector)")
Yann 0:fa858f79d48d 200
Yann 0:fa858f79d48d 201 int length = (p_length2write == -1) ? p_datas.size() : p_length2write;
Yann 0:fa858f79d48d 202 unsigned char array[length];
Yann 0:fa858f79d48d 203 std::copy(p_datas.begin(), p_datas.end(), array);
Yann 0:fa858f79d48d 204 bool result = Write(p_address, array, p_storeLength, length);
Yann 0:fa858f79d48d 205 wait(0.02);
Yann 0:fa858f79d48d 206
Yann 0:fa858f79d48d 207 DEBUG_LEAVE("CFM24VXX_I2C::Write (std::vector): %d", result)
Yann 0:fa858f79d48d 208 return result;
Yann 0:fa858f79d48d 209 }
Yann 0:fa858f79d48d 210
Yann 0:fa858f79d48d 211 bool CFM24VXX_I2C::Write(const short p_address, const char *p_datas, const bool p_storeLength, const int p_length2write) {
Yann 0:fa858f79d48d 212 DEBUG_ENTER("CFM24VXX_I2C::Write (char *): Memory address: 0x%02x - %x - %d", p_address, p_storeLength, p_length2write)
Yann 0:fa858f79d48d 213
Yann 0:fa858f79d48d 214 // 1.Prepare buffer
Yann 0:fa858f79d48d 215 int length = (p_length2write == -1) ? strlen(p_datas) : p_length2write;
Yann 0:fa858f79d48d 216 if (p_storeLength) {
Yann 0:fa858f79d48d 217 length += 4; // Add four bytes for the length as integer
Yann 0:fa858f79d48d 218 }
Yann 0:fa858f79d48d 219 DEBUG("CFM24VXX_I2C::Write (char *): length:%d", length)
Yann 0:fa858f79d48d 220
Yann 0:fa858f79d48d 221 char i2cBuffer[2 + length];
Yann 0:fa858f79d48d 222 // 1.1. Memory address
Yann 0:fa858f79d48d 223 short address = p_address + 1;
Yann 0:fa858f79d48d 224 i2cBuffer[0] = (unsigned char)(address >> 8);
Yann 0:fa858f79d48d 225 DEBUG("CFM24VXX_I2C::Write (char *): pI2CBuffer[0]: 0x%02x", i2cBuffer[0])
Yann 0:fa858f79d48d 226 i2cBuffer[1] = (unsigned char)((unsigned char)address & 0xff);
Yann 0:fa858f79d48d 227 DEBUG("CFM24VXX_I2C::Write (char *): pI2CBuffer[1]: 0x%02x", i2cBuffer[1])
Yann 0:fa858f79d48d 228 // 1.2. Datas
Yann 0:fa858f79d48d 229 if (p_storeLength) {
Yann 0:fa858f79d48d 230 // Fill the length
Yann 0:fa858f79d48d 231 i2cBuffer[2] = (unsigned char)(length >> 24);
Yann 0:fa858f79d48d 232 i2cBuffer[3] = (unsigned char)(length >> 16);
Yann 0:fa858f79d48d 233 i2cBuffer[4] = (unsigned char)(length >> 8);
Yann 0:fa858f79d48d 234 i2cBuffer[5] = (unsigned char)((unsigned char)length & 0xff);
Yann 0:fa858f79d48d 235 for (int i = 0; i < length - 4; i++) {
Yann 0:fa858f79d48d 236 i2cBuffer[6 + i] = *(p_datas + i);
Yann 0:fa858f79d48d 237 }
Yann 0:fa858f79d48d 238 } else { // The length was not stored
Yann 0:fa858f79d48d 239 for (int i = 0; i < length; i++) {
Yann 0:fa858f79d48d 240 i2cBuffer[2 + i] = *(p_datas + i);
Yann 0:fa858f79d48d 241 }
Yann 0:fa858f79d48d 242 }
Yann 0:fa858f79d48d 243
Yann 0:fa858f79d48d 244 // 2. Send I2C start + I2C address + Memory Address + Datas + I2C stop
Yann 0:fa858f79d48d 245 int result = _i2cInstance->write(_slaveAddress, i2cBuffer, 2 + length);
Yann 0:fa858f79d48d 246 wait(0.02);
Yann 0:fa858f79d48d 247
Yann 0:fa858f79d48d 248 DEBUG_LEAVE("CFM24VXX_I2C::Write (char *) %x", (bool)(result == 0))
Yann 0:fa858f79d48d 249 return (bool)(result == 0);
Yann 0:fa858f79d48d 250 }
Yann 0:fa858f79d48d 251
Yann 0:fa858f79d48d 252 bool CFM24VXX_I2C::Write(const short p_address, const unsigned char *p_datas, const bool p_storeLength, const int p_length2write) {
Yann 0:fa858f79d48d 253 DEBUG_ENTER("CFM24VXX_I2C::Write (byte *): Memory address: 0x%02x - %x - %d", p_address, p_storeLength, p_length2write)
Yann 0:fa858f79d48d 254 return Write(p_address, (const char *)p_datas, p_storeLength, p_length2write);
Yann 0:fa858f79d48d 255 }
Yann 0:fa858f79d48d 256
Yann 0:fa858f79d48d 257 bool CFM24VXX_I2C::Read(const short p_address, unsigned char * p_byte) {
Yann 0:fa858f79d48d 258 DEBUG_ENTER("CFM24VXX_I2C::Read (byte): Memory address:0x%02x", p_address)
Yann 0:fa858f79d48d 259
Yann 0:fa858f79d48d 260 // 1.Prepare buffer
Yann 0:fa858f79d48d 261 char i2cBuffer[2];
Yann 0:fa858f79d48d 262 // 1.1. Memory address
Yann 0:fa858f79d48d 263 i2cBuffer[0] = (unsigned char)(p_address >> 8);
Yann 0:fa858f79d48d 264 DEBUG("CFM24VXX_I2C::Read (byte): pI2CBuffer[0]: 0x%02x", i2cBuffer[0])
Yann 0:fa858f79d48d 265 i2cBuffer[1] = (unsigned char)((unsigned char)p_address & 0xff);
Yann 0:fa858f79d48d 266 DEBUG("CFM24VXX_I2C::Read (byte): pI2CBuffer[1]: 0x%02x", i2cBuffer[1])
Yann 0:fa858f79d48d 267
Yann 0:fa858f79d48d 268 // 2. Send I2C start + memory address
Yann 0:fa858f79d48d 269 if (_i2cInstance->write(_slaveAddress, i2cBuffer, 2, true) == 0) {
Yann 0:fa858f79d48d 270 wait(0.02);
Yann 0:fa858f79d48d 271 DEBUG("CFM24VXX_I2C::Read (byte): Write memory done")
Yann 0:fa858f79d48d 272 // 2. Read data + I2C stop
Yann 0:fa858f79d48d 273 int result = _i2cInstance->read(_slaveAddress, (char *)p_byte, 1);
Yann 0:fa858f79d48d 274 wait(0.02);
Yann 0:fa858f79d48d 275
Yann 0:fa858f79d48d 276 DEBUG_LEAVE("CFM24VXX_I2C::Read (byte): %x", (bool)(result == 0))
Yann 0:fa858f79d48d 277 return (bool)(result == 0);
Yann 0:fa858f79d48d 278 }
Yann 0:fa858f79d48d 279
Yann 0:fa858f79d48d 280 DEBUG_LEAVE("CFM24VXX_I2C::Read (byte) (false)")
Yann 0:fa858f79d48d 281 return false;
Yann 0:fa858f79d48d 282 }
Yann 0:fa858f79d48d 283
Yann 0:fa858f79d48d 284 bool CFM24VXX_I2C::Read(const short p_address, short *p_short, const CFM24VXX_I2C::Mode p_mode) {
Yann 0:fa858f79d48d 285 DEBUG_ENTER("CFM24VXX_I2C::Read (short): Memory address:0x%02x, Mode:%d", p_address, p_mode)
Yann 0:fa858f79d48d 286
Yann 0:fa858f79d48d 287 // 1.Prepare buffer
Yann 0:fa858f79d48d 288 char i2cBuffer[2];
Yann 0:fa858f79d48d 289 // 1.1. Memory address
Yann 0:fa858f79d48d 290 i2cBuffer[0] = (unsigned char)(p_address >> 8);
Yann 0:fa858f79d48d 291 DEBUG("CFM24VXX_I2C::Read (short): pI2CBuffer[0]: 0x%02x", i2cBuffer[0])
Yann 0:fa858f79d48d 292 i2cBuffer[1] = (unsigned char)((unsigned char)p_address & 0xff);
Yann 0:fa858f79d48d 293 DEBUG("CFM24VXX_I2C::Read (short): pI2CBuffer[1]: 0x%02x", i2cBuffer[1])
Yann 0:fa858f79d48d 294
Yann 0:fa858f79d48d 295 // 2. Send I2C start + memory address
Yann 0:fa858f79d48d 296 if (_i2cInstance->write(_slaveAddress, i2cBuffer, 2, true) == 0) {
Yann 0:fa858f79d48d 297 wait(0.02);
Yann 0:fa858f79d48d 298 DEBUG("CFM24VXX_I2C::Read (short): Write memory done")
Yann 0:fa858f79d48d 299 // 2. Read data + I2C stop
Yann 0:fa858f79d48d 300 int result = _i2cInstance->read(_slaveAddress, i2cBuffer, 2);
Yann 0:fa858f79d48d 301 if (result == 0) {
Yann 0:fa858f79d48d 302 DEBUG("CFM24VXX_I2C::Read (short): value: 0x%02x - 0x%02x", i2cBuffer[0], i2cBuffer[1])
Yann 0:fa858f79d48d 303 if (p_mode == BigEndian) {
Yann 0:fa858f79d48d 304 *p_short = (short)(i2cBuffer[0] << 8 | i2cBuffer[1]);
Yann 0:fa858f79d48d 305 } else {
Yann 0:fa858f79d48d 306 *p_short = (short)(i2cBuffer[1] << 8 | i2cBuffer[0]);
Yann 0:fa858f79d48d 307 }
Yann 0:fa858f79d48d 308
Yann 0:fa858f79d48d 309 DEBUG_LEAVE("CFM24VXX_I2C::Read (short): 0x%04x", *p_short)
Yann 0:fa858f79d48d 310 return true;
Yann 0:fa858f79d48d 311 }
Yann 0:fa858f79d48d 312 }
Yann 0:fa858f79d48d 313
Yann 0:fa858f79d48d 314 DEBUG_LEAVE("CFM24VXX_I2C::Read (short) (false)")
Yann 0:fa858f79d48d 315 return false;
Yann 0:fa858f79d48d 316 }
Yann 0:fa858f79d48d 317
Yann 0:fa858f79d48d 318 bool CFM24VXX_I2C::Read(const short p_address, int *p_int, const CFM24VXX_I2C::Mode p_mode) {
Yann 0:fa858f79d48d 319 DEBUG_ENTER("CFM24VXX_I2C::Read (int): Memory address:0x%02x, Mode:%d", p_address, p_mode)
Yann 0:fa858f79d48d 320
Yann 0:fa858f79d48d 321 // 1.Prepare buffer
Yann 0:fa858f79d48d 322 char i2cBuffer[4];
Yann 0:fa858f79d48d 323 // 1.1. Memory address
Yann 0:fa858f79d48d 324 i2cBuffer[0] = (unsigned char)(p_address >> 8);
Yann 0:fa858f79d48d 325 DEBUG("CFM24VXX_I2C::Read (int): pI2CBuffer[0]: 0x%02x", i2cBuffer[0])
Yann 0:fa858f79d48d 326 i2cBuffer[1] = (unsigned char)((unsigned char)p_address & 0xff);
Yann 0:fa858f79d48d 327 DEBUG("CFM24VXX_I2C::Read (int): pI2CBuffer[1]: 0x%02x", i2cBuffer[1])
Yann 0:fa858f79d48d 328
Yann 0:fa858f79d48d 329 // 2. Send I2C start + memory address
Yann 0:fa858f79d48d 330 if (_i2cInstance->write(_slaveAddress, i2cBuffer, 2, true) == 0) {
Yann 0:fa858f79d48d 331 wait(0.02);
Yann 0:fa858f79d48d 332 DEBUG("CFM24VXX_I2C::Read (int): Write memory done")
Yann 0:fa858f79d48d 333 // 2. Read data + I2C stop
Yann 0:fa858f79d48d 334 int result = _i2cInstance->read(_slaveAddress, i2cBuffer, 4);
Yann 0:fa858f79d48d 335 if (result == 0) {
Yann 0:fa858f79d48d 336 DEBUG("CFM24VXX_I2C::Read (int): value: 0x%02x - 0x%02x - 0x%02x - 0x%02x", i2cBuffer[0], i2cBuffer[1], i2cBuffer[2], i2cBuffer[3])
Yann 0:fa858f79d48d 337 wait(0.02);
Yann 0:fa858f79d48d 338 if (p_mode == BigEndian) {
Yann 0:fa858f79d48d 339 *p_int = (int)(i2cBuffer[0] << 24 | i2cBuffer[1] << 16 | i2cBuffer[2] << 8 | i2cBuffer[3]);
Yann 0:fa858f79d48d 340 } else {
Yann 0:fa858f79d48d 341 *p_int = (int)(i2cBuffer[3] << 24 | i2cBuffer[2] << 16 | i2cBuffer[1] << 8 | i2cBuffer[0]);
Yann 0:fa858f79d48d 342 }
Yann 0:fa858f79d48d 343
Yann 0:fa858f79d48d 344 DEBUG_LEAVE("CFM24VXX_I2C::Read (int): %d", *p_int)
Yann 0:fa858f79d48d 345 return true;
Yann 0:fa858f79d48d 346 }
Yann 0:fa858f79d48d 347
Yann 0:fa858f79d48d 348 DEBUG_LEAVE("CFM24VXX_I2C::Read (int):false")
Yann 0:fa858f79d48d 349 return false;
Yann 0:fa858f79d48d 350 }
Yann 0:fa858f79d48d 351
Yann 0:fa858f79d48d 352 DEBUG_LEAVE("CFM24VXX_I2C::Read (int) (false)")
Yann 0:fa858f79d48d 353 return false;
Yann 0:fa858f79d48d 354 }
Yann 0:fa858f79d48d 355
Yann 0:fa858f79d48d 356 bool CFM24VXX_I2C::Read(const short p_address, std::vector<unsigned char> & p_datas, const bool p_readLengthFirst, const int p_length2write) {
Yann 0:fa858f79d48d 357 DEBUG_ENTER("CFM24VXX_I2C::Read (vector): Memory address:0x%02x, readLength:%01x, Length:%d", p_address, p_readLengthFirst, p_length2write)
Yann 0:fa858f79d48d 358
Yann 0:fa858f79d48d 359 // 1.Prepare buffer
Yann 0:fa858f79d48d 360 short address = p_address;
Yann 0:fa858f79d48d 361 int length = 0;
Yann 0:fa858f79d48d 362 if (p_readLengthFirst) {
Yann 0:fa858f79d48d 363 if (!Read(address, &length)) { // Read the length in big endian mode
Yann 0:fa858f79d48d 364 DEBUG_LEAVE("CFM24VXX_I2C::Read (vector) Failed to read length")
Yann 0:fa858f79d48d 365 return false;
Yann 0:fa858f79d48d 366 }
Yann 0:fa858f79d48d 367 DEBUG("CFM24VXX_I2C::Read (vector): length= %d", length)
Yann 0:fa858f79d48d 368 if (length == 0) {
Yann 0:fa858f79d48d 369 return true;
Yann 0:fa858f79d48d 370 }
Yann 0:fa858f79d48d 371 address += 4; // Skip the length value
Yann 0:fa858f79d48d 372 length -= 4; // length is the size of (string length + string)
Yann 0:fa858f79d48d 373 } else {
Yann 0:fa858f79d48d 374 if (p_length2write == -1) {
Yann 0:fa858f79d48d 375 length = p_datas.size();
Yann 0:fa858f79d48d 376 } else {
Yann 0:fa858f79d48d 377 length = p_length2write;
Yann 0:fa858f79d48d 378 }
Yann 0:fa858f79d48d 379 }
Yann 0:fa858f79d48d 380 DEBUG("CFM24VXX_I2C::Read (vector): length= %d", length)
Yann 0:fa858f79d48d 381
Yann 0:fa858f79d48d 382 // 2. Memory address
Yann 0:fa858f79d48d 383 char i2cBuffer[2];
Yann 0:fa858f79d48d 384 i2cBuffer[0] = (unsigned char)(address >> 8);
Yann 0:fa858f79d48d 385 DEBUG("CFM24VXX_I2C::Read (vector): pI2CBuffer[0]: 0x%02x", i2cBuffer[0])
Yann 0:fa858f79d48d 386 i2cBuffer[1] = (unsigned char)((unsigned char)address & 0xff);
Yann 0:fa858f79d48d 387 DEBUG("CFM24VXX_I2C::Read (vector): pI2CBuffer[1]: 0x%02x", i2cBuffer[1])
Yann 0:fa858f79d48d 388
Yann 0:fa858f79d48d 389 // 3. Send I2C start + memory address
Yann 0:fa858f79d48d 390 if (_i2cInstance->write(_slaveAddress, i2cBuffer, 2, true) == 0) {
Yann 0:fa858f79d48d 391 wait(0.02);
Yann 0:fa858f79d48d 392 DEBUG("CFM24VXX_I2C::Read (vector): Write memory done")
Yann 0:fa858f79d48d 393 // 4. read data + I2C stop
Yann 0:fa858f79d48d 394 unsigned char buffer[length];
Yann 0:fa858f79d48d 395 int result = _i2cInstance->read(_slaveAddress, (char *)buffer, length);
Yann 0:fa858f79d48d 396 wait(0.02);
Yann 0:fa858f79d48d 397 if (result == 0) {
Yann 0:fa858f79d48d 398 p_datas.assign(buffer, buffer + length);
Yann 0:fa858f79d48d 399
Yann 0:fa858f79d48d 400 DEBUG_LEAVE("CFM24VXX_I2C::Read (vector): %x", (bool)(result == 0))
Yann 0:fa858f79d48d 401 return (bool)(result == 0);
Yann 0:fa858f79d48d 402 }
Yann 0:fa858f79d48d 403 }
Yann 0:fa858f79d48d 404
Yann 0:fa858f79d48d 405 DEBUG_LEAVE("CFM24VXX_I2C::Read (vector) (false)")
Yann 0:fa858f79d48d 406 return false;
Yann 0:fa858f79d48d 407 }
Yann 0:fa858f79d48d 408
Yann 0:fa858f79d48d 409 bool CFM24VXX_I2C::Read(const short p_address, std::string & p_string, const bool p_readLengthFirst, const int p_length2write) {
Yann 0:fa858f79d48d 410 DEBUG_ENTER("CFM24VXX_I2C::Read (string): Memory address:0x%02x, readLength:%01x, Length:%d", p_address, p_readLengthFirst, p_length2write)
Yann 0:fa858f79d48d 411
Yann 0:fa858f79d48d 412 /* std::vector<unsigned char> datas;
Yann 0:fa858f79d48d 413 if (Read(p_address, datas, p_readLengthFirst, p_length2write) == true) {
Yann 0:fa858f79d48d 414 p_string.assign((char *)datas.begin(), datas.size());
Yann 0:fa858f79d48d 415
Yann 0:fa858f79d48d 416 return true;
Yann 0:fa858f79d48d 417 }
Yann 0:fa858f79d48d 418
Yann 0:fa858f79d48d 419 DEBUG_LEAVE("CFM24VXX_I2C::Read (string) (false)")
Yann 0:fa858f79d48d 420 return false;
Yann 0:fa858f79d48d 421 */
Yann 0:fa858f79d48d 422
Yann 0:fa858f79d48d 423 // 1.Prepare buffer
Yann 0:fa858f79d48d 424 short address = p_address;
Yann 0:fa858f79d48d 425 int length = -1;
Yann 0:fa858f79d48d 426 if (p_readLengthFirst) { // The string was stored with its length
Yann 0:fa858f79d48d 427 if (!Read(address, &length)) { // Read the length as integer in big endian mode
Yann 0:fa858f79d48d 428 DEBUG_ERROR("CFM24VXX_I2C::Read (string): Failed to read length")
Yann 0:fa858f79d48d 429 return false;
Yann 0:fa858f79d48d 430 }
Yann 0:fa858f79d48d 431 wait(0.02);
Yann 0:fa858f79d48d 432 DEBUG("CFM24VXX_I2C::Read (string): length=%d", length)
Yann 0:fa858f79d48d 433 if (length == 0) {
Yann 0:fa858f79d48d 434 DEBUG_ERROR("CFM24VXX_I2C::Read (string): empty")
Yann 0:fa858f79d48d 435 return true;
Yann 0:fa858f79d48d 436 }
Yann 0:fa858f79d48d 437 address += 4; // Skip the length value size
Yann 0:fa858f79d48d 438 length -= 4; // length is the size of (string length + string)
Yann 0:fa858f79d48d 439 } else { // The string length is provided by p_length2write parameter
Yann 0:fa858f79d48d 440 if (p_length2write == -1) {
Yann 0:fa858f79d48d 441 length = p_string.size();
Yann 0:fa858f79d48d 442 } else {
Yann 0:fa858f79d48d 443 length = p_length2write;
Yann 0:fa858f79d48d 444 p_string.resize(p_length2write);
Yann 0:fa858f79d48d 445 }
Yann 0:fa858f79d48d 446 }
Yann 0:fa858f79d48d 447 DEBUG("CFM24VXX_I2C::Read (string): Address=0x%02x - Length=%d", address, length)
Yann 0:fa858f79d48d 448
Yann 0:fa858f79d48d 449 // 2. Memory address
Yann 0:fa858f79d48d 450 char i2cBuffer[2];
Yann 0:fa858f79d48d 451 i2cBuffer[0] = (unsigned char)(address >> 8);
Yann 0:fa858f79d48d 452 DEBUG("CFM24VXX_I2C::Read (string): pI2CBuffer[0]: 0x%02x", i2cBuffer[0])
Yann 0:fa858f79d48d 453 i2cBuffer[1] = (unsigned char)((unsigned char)address & 0xff);
Yann 0:fa858f79d48d 454 DEBUG("CFM24VXX_I2C::Read (string): pI2CBuffer[1]: 0x%02x", i2cBuffer[1])
Yann 0:fa858f79d48d 455
Yann 0:fa858f79d48d 456 // 3. Send I2C start + memory address with repeat start
Yann 0:fa858f79d48d 457 if (_i2cInstance->write(_slaveAddress, i2cBuffer, 2, true) == 0) {
Yann 0:fa858f79d48d 458 wait(0.02);
Yann 0:fa858f79d48d 459 DEBUG("CFM24VXX_I2C::Read (string): Write memory done")
Yann 0:fa858f79d48d 460 // 4. Read data + I2C stop
Yann 0:fa858f79d48d 461 char buffer[length];
Yann 0:fa858f79d48d 462 int result = _i2cInstance->read(_slaveAddress, (char *)buffer, length);
Yann 0:fa858f79d48d 463 if (result == 0) {
Yann 0:fa858f79d48d 464 p_string.assign(buffer, length);
Yann 0:fa858f79d48d 465
Yann 0:fa858f79d48d 466 return true;
Yann 0:fa858f79d48d 467 }
Yann 0:fa858f79d48d 468 }
Yann 0:fa858f79d48d 469
Yann 0:fa858f79d48d 470 DEBUG_LEAVE("CFM24VXX_I2C::Read (string) (false)")
Yann 0:fa858f79d48d 471 return false;
Yann 0:fa858f79d48d 472 }
Yann 0:fa858f79d48d 473
Yann 0:fa858f79d48d 474 #if defined(__DEBUG)
Yann 0:fa858f79d48d 475 void CFM24VXX_I2C::DumpMemoryArea(const int p_address, const int p_count) {
Yann 0:fa858f79d48d 476 DEBUG_ENTER("CFM24VXX_I2C::DumpMemoryArea: %d - %d", p_address, p_count)
Yann 0:fa858f79d48d 477
Yann 0:fa858f79d48d 478 DEBUG("CFM24VXX_I2C::DumpMemoryArea: Reading datas...");
Yann 0:fa858f79d48d 479 std::vector<unsigned char> datas(p_count);
Yann 0:fa858f79d48d 480 if (!Read(p_address, datas, false)) { // Read bytes, including the lenght indication, buffer size is not set before the call
Yann 0:fa858f79d48d 481 std::cout << "CFM24VXX_I2C::DumpMemoryArea: read failed\r" << std::endl;
Yann 0:fa858f79d48d 482 } else {
Yann 0:fa858f79d48d 483 std::cout << "CFM24VXX_I2C::DumpMemoryArea: Read bytes:\r" << std::endl;
Yann 0:fa858f79d48d 484 HEXADUMP(&datas[0], p_count);
Yann 0:fa858f79d48d 485 std::cout << "\r" << std::endl;
Yann 0:fa858f79d48d 486 }
Yann 0:fa858f79d48d 487 }
Yann 0:fa858f79d48d 488 #endif // _DEBUG
Yann 0:fa858f79d48d 489
Yann 0:fa858f79d48d 490 } // End of namespace _FM24VXX_I2C