mbed library sources

Dependents:   Encrypted my_mbed lklk CyaSSL_DTLS_Cellular ... more

Superseded

This library was superseded by mbed-dev - https://os.mbed.com/users/mbed_official/code/mbed-dev/.

Development branch of the mbed library sources. This library is kept in synch with the latest changes from the mbed SDK and it is not guaranteed to work.

If you are looking for a stable and tested release, please import one of the official mbed library releases:

Import librarymbed

The official Mbed 2 C/C++ SDK provides the software platform and libraries to build your applications.

Committer:
bogdanm
Date:
Mon Aug 05 14:12:34 2013 +0300
Revision:
13:0645d8841f51
Child:
227:7bd0639b8911
Update mbed sources to revision 64

Who changed what in which revision?

UserRevisionLine numberNew contents of line
bogdanm 13:0645d8841f51 1 /* mbed Microcontroller Library
bogdanm 13:0645d8841f51 2 * Copyright (c) 2006-2013 ARM Limited
bogdanm 13:0645d8841f51 3 *
bogdanm 13:0645d8841f51 4 * Licensed under the Apache License, Version 2.0 (the "License");
bogdanm 13:0645d8841f51 5 * you may not use this file except in compliance with the License.
bogdanm 13:0645d8841f51 6 * You may obtain a copy of the License at
bogdanm 13:0645d8841f51 7 *
bogdanm 13:0645d8841f51 8 * http://www.apache.org/licenses/LICENSE-2.0
bogdanm 13:0645d8841f51 9 *
bogdanm 13:0645d8841f51 10 * Unless required by applicable law or agreed to in writing, software
bogdanm 13:0645d8841f51 11 * distributed under the License is distributed on an "AS IS" BASIS,
bogdanm 13:0645d8841f51 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
bogdanm 13:0645d8841f51 13 * See the License for the specific language governing permissions and
bogdanm 13:0645d8841f51 14 * limitations under the License.
bogdanm 13:0645d8841f51 15 */
bogdanm 13:0645d8841f51 16 #include "i2c_api.h"
bogdanm 13:0645d8841f51 17 #include "cmsis.h"
bogdanm 13:0645d8841f51 18 #include "pinmap.h"
bogdanm 13:0645d8841f51 19 #include "error.h"
bogdanm 13:0645d8841f51 20
bogdanm 13:0645d8841f51 21 static const PinMap PinMap_I2C_SDA[] = {
bogdanm 13:0645d8841f51 22 {P0_5, I2C_0, 1},
bogdanm 13:0645d8841f51 23 {NC , NC , 0}
bogdanm 13:0645d8841f51 24 };
bogdanm 13:0645d8841f51 25
bogdanm 13:0645d8841f51 26 static const PinMap PinMap_I2C_SCL[] = {
bogdanm 13:0645d8841f51 27 {P0_4, I2C_0, 1},
bogdanm 13:0645d8841f51 28 {NC , NC, 0}
bogdanm 13:0645d8841f51 29 };
bogdanm 13:0645d8841f51 30
bogdanm 13:0645d8841f51 31 #define I2C_CONSET(x) (x->i2c->CONSET)
bogdanm 13:0645d8841f51 32 #define I2C_CONCLR(x) (x->i2c->CONCLR)
bogdanm 13:0645d8841f51 33 #define I2C_STAT(x) (x->i2c->STAT)
bogdanm 13:0645d8841f51 34 #define I2C_DAT(x) (x->i2c->DAT)
bogdanm 13:0645d8841f51 35 #define I2C_SCLL(x, val) (x->i2c->SCLL = val)
bogdanm 13:0645d8841f51 36 #define I2C_SCLH(x, val) (x->i2c->SCLH = val)
bogdanm 13:0645d8841f51 37
bogdanm 13:0645d8841f51 38 static const uint32_t I2C_addr_offset[2][4] = {
bogdanm 13:0645d8841f51 39 {0x0C, 0x20, 0x24, 0x28},
bogdanm 13:0645d8841f51 40 {0x30, 0x34, 0x38, 0x3C}
bogdanm 13:0645d8841f51 41 };
bogdanm 13:0645d8841f51 42
bogdanm 13:0645d8841f51 43 static inline void i2c_conclr(i2c_t *obj, int start, int stop, int interrupt, int acknowledge) {
bogdanm 13:0645d8841f51 44 I2C_CONCLR(obj) = (start << 5)
bogdanm 13:0645d8841f51 45 | (stop << 4)
bogdanm 13:0645d8841f51 46 | (interrupt << 3)
bogdanm 13:0645d8841f51 47 | (acknowledge << 2);
bogdanm 13:0645d8841f51 48 }
bogdanm 13:0645d8841f51 49
bogdanm 13:0645d8841f51 50 static inline void i2c_conset(i2c_t *obj, int start, int stop, int interrupt, int acknowledge) {
bogdanm 13:0645d8841f51 51 I2C_CONSET(obj) = (start << 5)
bogdanm 13:0645d8841f51 52 | (stop << 4)
bogdanm 13:0645d8841f51 53 | (interrupt << 3)
bogdanm 13:0645d8841f51 54 | (acknowledge << 2);
bogdanm 13:0645d8841f51 55 }
bogdanm 13:0645d8841f51 56
bogdanm 13:0645d8841f51 57 // Clear the Serial Interrupt (SI)
bogdanm 13:0645d8841f51 58 static inline void i2c_clear_SI(i2c_t *obj) {
bogdanm 13:0645d8841f51 59 i2c_conclr(obj, 0, 0, 1, 0);
bogdanm 13:0645d8841f51 60 }
bogdanm 13:0645d8841f51 61
bogdanm 13:0645d8841f51 62 static inline int i2c_status(i2c_t *obj) {
bogdanm 13:0645d8841f51 63 return I2C_STAT(obj);
bogdanm 13:0645d8841f51 64 }
bogdanm 13:0645d8841f51 65
bogdanm 13:0645d8841f51 66 // Wait until the Serial Interrupt (SI) is set
bogdanm 13:0645d8841f51 67 static int i2c_wait_SI(i2c_t *obj) {
bogdanm 13:0645d8841f51 68 int timeout = 0;
bogdanm 13:0645d8841f51 69 while (!(I2C_CONSET(obj) & (1 << 3))) {
bogdanm 13:0645d8841f51 70 timeout++;
bogdanm 13:0645d8841f51 71 if (timeout > 100000) return -1;
bogdanm 13:0645d8841f51 72 }
bogdanm 13:0645d8841f51 73 return 0;
bogdanm 13:0645d8841f51 74 }
bogdanm 13:0645d8841f51 75
bogdanm 13:0645d8841f51 76 static inline void i2c_interface_enable(i2c_t *obj) {
bogdanm 13:0645d8841f51 77 I2C_CONSET(obj) = 0x40;
bogdanm 13:0645d8841f51 78 }
bogdanm 13:0645d8841f51 79
bogdanm 13:0645d8841f51 80 static inline void i2c_power_enable(i2c_t *obj) {
bogdanm 13:0645d8841f51 81 LPC_SYSCON->SYSAHBCLKCTRL |= (1 << 5);
bogdanm 13:0645d8841f51 82 LPC_SYSCON->PRESETCTRL |= 1 << 1;
bogdanm 13:0645d8841f51 83 }
bogdanm 13:0645d8841f51 84
bogdanm 13:0645d8841f51 85 void i2c_init(i2c_t *obj, PinName sda, PinName scl) {
bogdanm 13:0645d8841f51 86 // determine the SPI to use
bogdanm 13:0645d8841f51 87 I2CName i2c_sda = (I2CName)pinmap_peripheral(sda, PinMap_I2C_SDA);
bogdanm 13:0645d8841f51 88 I2CName i2c_scl = (I2CName)pinmap_peripheral(scl, PinMap_I2C_SCL);
bogdanm 13:0645d8841f51 89 obj->i2c = (LPC_I2C_Type *)pinmap_merge(i2c_sda, i2c_scl);
bogdanm 13:0645d8841f51 90
bogdanm 13:0645d8841f51 91 if ((int)obj->i2c == NC) {
bogdanm 13:0645d8841f51 92 error("I2C pin mapping failed");
bogdanm 13:0645d8841f51 93 }
bogdanm 13:0645d8841f51 94
bogdanm 13:0645d8841f51 95 // enable power
bogdanm 13:0645d8841f51 96 i2c_power_enable(obj);
bogdanm 13:0645d8841f51 97
bogdanm 13:0645d8841f51 98 // set default frequency at 100k
bogdanm 13:0645d8841f51 99 i2c_frequency(obj, 100000);
bogdanm 13:0645d8841f51 100 i2c_conclr(obj, 1, 1, 1, 1);
bogdanm 13:0645d8841f51 101 i2c_interface_enable(obj);
bogdanm 13:0645d8841f51 102
bogdanm 13:0645d8841f51 103 pinmap_pinout(sda, PinMap_I2C_SDA);
bogdanm 13:0645d8841f51 104 pinmap_pinout(scl, PinMap_I2C_SCL);
bogdanm 13:0645d8841f51 105 }
bogdanm 13:0645d8841f51 106
bogdanm 13:0645d8841f51 107 inline int i2c_start(i2c_t *obj) {
bogdanm 13:0645d8841f51 108 int status = 0;
bogdanm 13:0645d8841f51 109 // 8.1 Before master mode can be entered, I2CON must be initialised to:
bogdanm 13:0645d8841f51 110 // - I2EN STA STO SI AA - -
bogdanm 13:0645d8841f51 111 // - 1 0 0 0 x - -
bogdanm 13:0645d8841f51 112 // if AA = 0, it can't enter slave mode
bogdanm 13:0645d8841f51 113 i2c_conclr(obj, 1, 1, 1, 1);
bogdanm 13:0645d8841f51 114
bogdanm 13:0645d8841f51 115 // The master mode may now be entered by setting the STA bit
bogdanm 13:0645d8841f51 116 // this will generate a start condition when the bus becomes free
bogdanm 13:0645d8841f51 117 i2c_conset(obj, 1, 0, 0, 1);
bogdanm 13:0645d8841f51 118
bogdanm 13:0645d8841f51 119 i2c_wait_SI(obj);
bogdanm 13:0645d8841f51 120 status = i2c_status(obj);
bogdanm 13:0645d8841f51 121
bogdanm 13:0645d8841f51 122 // Clear start bit now transmitted, and interrupt bit
bogdanm 13:0645d8841f51 123 i2c_conclr(obj, 1, 0, 0, 0);
bogdanm 13:0645d8841f51 124 return status;
bogdanm 13:0645d8841f51 125 }
bogdanm 13:0645d8841f51 126
bogdanm 13:0645d8841f51 127 inline int i2c_stop(i2c_t *obj) {
bogdanm 13:0645d8841f51 128 int timeout = 0;
bogdanm 13:0645d8841f51 129
bogdanm 13:0645d8841f51 130 // write the stop bit
bogdanm 13:0645d8841f51 131 i2c_conset(obj, 0, 1, 0, 0);
bogdanm 13:0645d8841f51 132 i2c_clear_SI(obj);
bogdanm 13:0645d8841f51 133
bogdanm 13:0645d8841f51 134 // wait for STO bit to reset
bogdanm 13:0645d8841f51 135 while(I2C_CONSET(obj) & (1 << 4)) {
bogdanm 13:0645d8841f51 136 timeout ++;
bogdanm 13:0645d8841f51 137 if (timeout > 100000) return 1;
bogdanm 13:0645d8841f51 138 }
bogdanm 13:0645d8841f51 139
bogdanm 13:0645d8841f51 140 return 0;
bogdanm 13:0645d8841f51 141 }
bogdanm 13:0645d8841f51 142
bogdanm 13:0645d8841f51 143
bogdanm 13:0645d8841f51 144 static inline int i2c_do_write(i2c_t *obj, int value, uint8_t addr) {
bogdanm 13:0645d8841f51 145 // write the data
bogdanm 13:0645d8841f51 146 I2C_DAT(obj) = value;
bogdanm 13:0645d8841f51 147
bogdanm 13:0645d8841f51 148 // clear SI to init a send
bogdanm 13:0645d8841f51 149 i2c_clear_SI(obj);
bogdanm 13:0645d8841f51 150
bogdanm 13:0645d8841f51 151 // wait and return status
bogdanm 13:0645d8841f51 152 i2c_wait_SI(obj);
bogdanm 13:0645d8841f51 153 return i2c_status(obj);
bogdanm 13:0645d8841f51 154 }
bogdanm 13:0645d8841f51 155
bogdanm 13:0645d8841f51 156 static inline int i2c_do_read(i2c_t *obj, int last) {
bogdanm 13:0645d8841f51 157 // we are in state 0x40 (SLA+R tx'd) or 0x50 (data rx'd and ack)
bogdanm 13:0645d8841f51 158 if (last) {
bogdanm 13:0645d8841f51 159 i2c_conclr(obj, 0, 0, 0, 1); // send a NOT ACK
bogdanm 13:0645d8841f51 160 } else {
bogdanm 13:0645d8841f51 161 i2c_conset(obj, 0, 0, 0, 1); // send a ACK
bogdanm 13:0645d8841f51 162 }
bogdanm 13:0645d8841f51 163
bogdanm 13:0645d8841f51 164 // accept byte
bogdanm 13:0645d8841f51 165 i2c_clear_SI(obj);
bogdanm 13:0645d8841f51 166
bogdanm 13:0645d8841f51 167 // wait for it to arrive
bogdanm 13:0645d8841f51 168 i2c_wait_SI(obj);
bogdanm 13:0645d8841f51 169
bogdanm 13:0645d8841f51 170 // return the data
bogdanm 13:0645d8841f51 171 return (I2C_DAT(obj) & 0xFF);
bogdanm 13:0645d8841f51 172 }
bogdanm 13:0645d8841f51 173
bogdanm 13:0645d8841f51 174 void i2c_frequency(i2c_t *obj, int hz) {
bogdanm 13:0645d8841f51 175 // No peripheral clock divider on the M0
bogdanm 13:0645d8841f51 176 uint32_t PCLK = SystemCoreClock;
bogdanm 13:0645d8841f51 177
bogdanm 13:0645d8841f51 178 uint32_t pulse = PCLK / (hz * 2);
bogdanm 13:0645d8841f51 179
bogdanm 13:0645d8841f51 180 // I2C Rate
bogdanm 13:0645d8841f51 181 I2C_SCLL(obj, pulse);
bogdanm 13:0645d8841f51 182 I2C_SCLH(obj, pulse);
bogdanm 13:0645d8841f51 183 }
bogdanm 13:0645d8841f51 184
bogdanm 13:0645d8841f51 185 // The I2C does a read or a write as a whole operation
bogdanm 13:0645d8841f51 186 // There are two types of error conditions it can encounter
bogdanm 13:0645d8841f51 187 // 1) it can not obtain the bus
bogdanm 13:0645d8841f51 188 // 2) it gets error responses at part of the transmission
bogdanm 13:0645d8841f51 189 //
bogdanm 13:0645d8841f51 190 // We tackle them as follows:
bogdanm 13:0645d8841f51 191 // 1) we retry until we get the bus. we could have a "timeout" if we can not get it
bogdanm 13:0645d8841f51 192 // which basically turns it in to a 2)
bogdanm 13:0645d8841f51 193 // 2) on error, we use the standard error mechanisms to report/debug
bogdanm 13:0645d8841f51 194 //
bogdanm 13:0645d8841f51 195 // Therefore an I2C transaction should always complete. If it doesn't it is usually
bogdanm 13:0645d8841f51 196 // because something is setup wrong (e.g. wiring), and we don't need to programatically
bogdanm 13:0645d8841f51 197 // check for that
bogdanm 13:0645d8841f51 198
bogdanm 13:0645d8841f51 199 int i2c_read(i2c_t *obj, int address, char *data, int length, int stop) {
bogdanm 13:0645d8841f51 200 int count, status;
bogdanm 13:0645d8841f51 201
bogdanm 13:0645d8841f51 202 status = i2c_start(obj);
bogdanm 13:0645d8841f51 203
bogdanm 13:0645d8841f51 204 if ((status != 0x10) && (status != 0x08)) {
bogdanm 13:0645d8841f51 205 i2c_stop(obj);
bogdanm 13:0645d8841f51 206 return I2C_ERROR_BUS_BUSY;
bogdanm 13:0645d8841f51 207 }
bogdanm 13:0645d8841f51 208
bogdanm 13:0645d8841f51 209 status = i2c_do_write(obj, (address | 0x01), 1);
bogdanm 13:0645d8841f51 210 if (status != 0x40) {
bogdanm 13:0645d8841f51 211 i2c_stop(obj);
bogdanm 13:0645d8841f51 212 return I2C_ERROR_NO_SLAVE;
bogdanm 13:0645d8841f51 213 }
bogdanm 13:0645d8841f51 214
bogdanm 13:0645d8841f51 215 // Read in all except last byte
bogdanm 13:0645d8841f51 216 for (count = 0; count < (length - 1); count++) {
bogdanm 13:0645d8841f51 217 int value = i2c_do_read(obj, 0);
bogdanm 13:0645d8841f51 218 status = i2c_status(obj);
bogdanm 13:0645d8841f51 219 if (status != 0x50) {
bogdanm 13:0645d8841f51 220 i2c_stop(obj);
bogdanm 13:0645d8841f51 221 return count;
bogdanm 13:0645d8841f51 222 }
bogdanm 13:0645d8841f51 223 data[count] = (char) value;
bogdanm 13:0645d8841f51 224 }
bogdanm 13:0645d8841f51 225
bogdanm 13:0645d8841f51 226 // read in last byte
bogdanm 13:0645d8841f51 227 int value = i2c_do_read(obj, 1);
bogdanm 13:0645d8841f51 228 status = i2c_status(obj);
bogdanm 13:0645d8841f51 229 if (status != 0x58) {
bogdanm 13:0645d8841f51 230 i2c_stop(obj);
bogdanm 13:0645d8841f51 231 return length - 1;
bogdanm 13:0645d8841f51 232 }
bogdanm 13:0645d8841f51 233
bogdanm 13:0645d8841f51 234 data[count] = (char) value;
bogdanm 13:0645d8841f51 235
bogdanm 13:0645d8841f51 236 // If not repeated start, send stop.
bogdanm 13:0645d8841f51 237 if (stop) {
bogdanm 13:0645d8841f51 238 i2c_stop(obj);
bogdanm 13:0645d8841f51 239 }
bogdanm 13:0645d8841f51 240
bogdanm 13:0645d8841f51 241 return length;
bogdanm 13:0645d8841f51 242 }
bogdanm 13:0645d8841f51 243
bogdanm 13:0645d8841f51 244 int i2c_write(i2c_t *obj, int address, const char *data, int length, int stop) {
bogdanm 13:0645d8841f51 245 int i, status;
bogdanm 13:0645d8841f51 246
bogdanm 13:0645d8841f51 247 status = i2c_start(obj);
bogdanm 13:0645d8841f51 248
bogdanm 13:0645d8841f51 249 if ((status != 0x10) && (status != 0x08)) {
bogdanm 13:0645d8841f51 250 i2c_stop(obj);
bogdanm 13:0645d8841f51 251 return I2C_ERROR_BUS_BUSY;
bogdanm 13:0645d8841f51 252 }
bogdanm 13:0645d8841f51 253
bogdanm 13:0645d8841f51 254 status = i2c_do_write(obj, (address & 0xFE), 1);
bogdanm 13:0645d8841f51 255 if (status != 0x18) {
bogdanm 13:0645d8841f51 256 i2c_stop(obj);
bogdanm 13:0645d8841f51 257 return I2C_ERROR_NO_SLAVE;
bogdanm 13:0645d8841f51 258 }
bogdanm 13:0645d8841f51 259
bogdanm 13:0645d8841f51 260 for (i=0; i<length; i++) {
bogdanm 13:0645d8841f51 261 status = i2c_do_write(obj, data[i], 0);
bogdanm 13:0645d8841f51 262 if(status != 0x28) {
bogdanm 13:0645d8841f51 263 i2c_stop(obj);
bogdanm 13:0645d8841f51 264 return i;
bogdanm 13:0645d8841f51 265 }
bogdanm 13:0645d8841f51 266 }
bogdanm 13:0645d8841f51 267
bogdanm 13:0645d8841f51 268 // clearing the serial interrupt here might cause an unintended rewrite of the last byte
bogdanm 13:0645d8841f51 269 // see also issue report https://mbed.org/users/mbed_official/code/mbed/issues/1
bogdanm 13:0645d8841f51 270 // i2c_clear_SI(obj);
bogdanm 13:0645d8841f51 271
bogdanm 13:0645d8841f51 272 // If not repeated start, send stop.
bogdanm 13:0645d8841f51 273 if (stop) {
bogdanm 13:0645d8841f51 274 i2c_stop(obj);
bogdanm 13:0645d8841f51 275 }
bogdanm 13:0645d8841f51 276
bogdanm 13:0645d8841f51 277 return length;
bogdanm 13:0645d8841f51 278 }
bogdanm 13:0645d8841f51 279
bogdanm 13:0645d8841f51 280 void i2c_reset(i2c_t *obj) {
bogdanm 13:0645d8841f51 281 i2c_stop(obj);
bogdanm 13:0645d8841f51 282 }
bogdanm 13:0645d8841f51 283
bogdanm 13:0645d8841f51 284 int i2c_byte_read(i2c_t *obj, int last) {
bogdanm 13:0645d8841f51 285 return (i2c_do_read(obj, last) & 0xFF);
bogdanm 13:0645d8841f51 286 }
bogdanm 13:0645d8841f51 287
bogdanm 13:0645d8841f51 288 int i2c_byte_write(i2c_t *obj, int data) {
bogdanm 13:0645d8841f51 289 int ack;
bogdanm 13:0645d8841f51 290 int status = i2c_do_write(obj, (data & 0xFF), 0);
bogdanm 13:0645d8841f51 291
bogdanm 13:0645d8841f51 292 switch(status) {
bogdanm 13:0645d8841f51 293 case 0x18: case 0x28: // Master transmit ACKs
bogdanm 13:0645d8841f51 294 ack = 1;
bogdanm 13:0645d8841f51 295 break;
bogdanm 13:0645d8841f51 296 case 0x40: // Master receive address transmitted ACK
bogdanm 13:0645d8841f51 297 ack = 1;
bogdanm 13:0645d8841f51 298 break;
bogdanm 13:0645d8841f51 299 case 0xB8: // Slave transmit ACK
bogdanm 13:0645d8841f51 300 ack = 1;
bogdanm 13:0645d8841f51 301 break;
bogdanm 13:0645d8841f51 302 default:
bogdanm 13:0645d8841f51 303 ack = 0;
bogdanm 13:0645d8841f51 304 break;
bogdanm 13:0645d8841f51 305 }
bogdanm 13:0645d8841f51 306
bogdanm 13:0645d8841f51 307 return ack;
bogdanm 13:0645d8841f51 308 }
bogdanm 13:0645d8841f51 309
bogdanm 13:0645d8841f51 310 void i2c_slave_mode(i2c_t *obj, int enable_slave) {
bogdanm 13:0645d8841f51 311 if (enable_slave != 0) {
bogdanm 13:0645d8841f51 312 i2c_conclr(obj, 1, 1, 1, 0);
bogdanm 13:0645d8841f51 313 i2c_conset(obj, 0, 0, 0, 1);
bogdanm 13:0645d8841f51 314 } else {
bogdanm 13:0645d8841f51 315 i2c_conclr(obj, 1, 1, 1, 1);
bogdanm 13:0645d8841f51 316 }
bogdanm 13:0645d8841f51 317 }
bogdanm 13:0645d8841f51 318
bogdanm 13:0645d8841f51 319 int i2c_slave_receive(i2c_t *obj) {
bogdanm 13:0645d8841f51 320 int status;
bogdanm 13:0645d8841f51 321 int retval;
bogdanm 13:0645d8841f51 322
bogdanm 13:0645d8841f51 323 status = i2c_status(obj);
bogdanm 13:0645d8841f51 324 switch(status) {
bogdanm 13:0645d8841f51 325 case 0x60: retval = 3; break;
bogdanm 13:0645d8841f51 326 case 0x70: retval = 2; break;
bogdanm 13:0645d8841f51 327 case 0xA8: retval = 1; break;
bogdanm 13:0645d8841f51 328 default : retval = 0; break;
bogdanm 13:0645d8841f51 329 }
bogdanm 13:0645d8841f51 330
bogdanm 13:0645d8841f51 331 return(retval);
bogdanm 13:0645d8841f51 332 }
bogdanm 13:0645d8841f51 333
bogdanm 13:0645d8841f51 334 int i2c_slave_read(i2c_t *obj, char *data, int length) {
bogdanm 13:0645d8841f51 335 int count = 0;
bogdanm 13:0645d8841f51 336 int status;
bogdanm 13:0645d8841f51 337
bogdanm 13:0645d8841f51 338 do {
bogdanm 13:0645d8841f51 339 i2c_clear_SI(obj);
bogdanm 13:0645d8841f51 340 i2c_wait_SI(obj);
bogdanm 13:0645d8841f51 341 status = i2c_status(obj);
bogdanm 13:0645d8841f51 342 if((status == 0x80) || (status == 0x90)) {
bogdanm 13:0645d8841f51 343 data[count] = I2C_DAT(obj) & 0xFF;
bogdanm 13:0645d8841f51 344 }
bogdanm 13:0645d8841f51 345 count++;
bogdanm 13:0645d8841f51 346 } while (((status == 0x80) || (status == 0x90) ||
bogdanm 13:0645d8841f51 347 (status == 0x060) || (status == 0x70)) && (count < length));
bogdanm 13:0645d8841f51 348
bogdanm 13:0645d8841f51 349 if(status != 0xA0) {
bogdanm 13:0645d8841f51 350 i2c_stop(obj);
bogdanm 13:0645d8841f51 351 }
bogdanm 13:0645d8841f51 352
bogdanm 13:0645d8841f51 353 i2c_clear_SI(obj);
bogdanm 13:0645d8841f51 354
bogdanm 13:0645d8841f51 355 return count;
bogdanm 13:0645d8841f51 356 }
bogdanm 13:0645d8841f51 357
bogdanm 13:0645d8841f51 358 int i2c_slave_write(i2c_t *obj, const char *data, int length) {
bogdanm 13:0645d8841f51 359 int count = 0;
bogdanm 13:0645d8841f51 360 int status;
bogdanm 13:0645d8841f51 361
bogdanm 13:0645d8841f51 362 if(length <= 0) {
bogdanm 13:0645d8841f51 363 return(0);
bogdanm 13:0645d8841f51 364 }
bogdanm 13:0645d8841f51 365
bogdanm 13:0645d8841f51 366 do {
bogdanm 13:0645d8841f51 367 status = i2c_do_write(obj, data[count], 0);
bogdanm 13:0645d8841f51 368 count++;
bogdanm 13:0645d8841f51 369 } while ((count < length) && (status == 0xB8));
bogdanm 13:0645d8841f51 370
bogdanm 13:0645d8841f51 371 if((status != 0xC0) && (status != 0xC8)) {
bogdanm 13:0645d8841f51 372 i2c_stop(obj);
bogdanm 13:0645d8841f51 373 }
bogdanm 13:0645d8841f51 374
bogdanm 13:0645d8841f51 375 i2c_clear_SI(obj);
bogdanm 13:0645d8841f51 376
bogdanm 13:0645d8841f51 377 return(count);
bogdanm 13:0645d8841f51 378 }
bogdanm 13:0645d8841f51 379
bogdanm 13:0645d8841f51 380 void i2c_slave_address(i2c_t *obj, int idx, uint32_t address, uint32_t mask) {
bogdanm 13:0645d8841f51 381 uint32_t addr;
bogdanm 13:0645d8841f51 382
bogdanm 13:0645d8841f51 383 if ((idx >= 0) && (idx <= 3)) {
bogdanm 13:0645d8841f51 384 addr = ((uint32_t)obj->i2c) + I2C_addr_offset[0][idx];
bogdanm 13:0645d8841f51 385 *((uint32_t *) addr) = address & 0xFF;
bogdanm 13:0645d8841f51 386 }
bogdanm 13:0645d8841f51 387 }