mbed library sources. With a patch for the can_api

Fork of mbed-dev by mbed official

Committer:
DangerousElectrician
Date:
Mon Nov 14 04:39:23 2016 +0000
Revision:
151:91825d030f9b
Parent:
149:156823d33999
stuff changed?

Who changed what in which revision?

UserRevisionLine numberNew contents of line
<> 144:ef7eb2e8f9f7 1 /* mbed Microcontroller Library
<> 144:ef7eb2e8f9f7 2 *******************************************************************************
<> 144:ef7eb2e8f9f7 3 * Copyright (c) 2015, STMicroelectronics
<> 144:ef7eb2e8f9f7 4 * All rights reserved.
<> 144:ef7eb2e8f9f7 5 *
<> 144:ef7eb2e8f9f7 6 * Redistribution and use in source and binary forms, with or without
<> 144:ef7eb2e8f9f7 7 * modification, are permitted provided that the following conditions are met:
<> 144:ef7eb2e8f9f7 8 *
<> 144:ef7eb2e8f9f7 9 * 1. Redistributions of source code must retain the above copyright notice,
<> 144:ef7eb2e8f9f7 10 * this list of conditions and the following disclaimer.
<> 144:ef7eb2e8f9f7 11 * 2. Redistributions in binary form must reproduce the above copyright notice,
<> 144:ef7eb2e8f9f7 12 * this list of conditions and the following disclaimer in the documentation
<> 144:ef7eb2e8f9f7 13 * and/or other materials provided with the distribution.
<> 144:ef7eb2e8f9f7 14 * 3. Neither the name of STMicroelectronics nor the names of its contributors
<> 144:ef7eb2e8f9f7 15 * may be used to endorse or promote products derived from this software
<> 144:ef7eb2e8f9f7 16 * without specific prior written permission.
<> 144:ef7eb2e8f9f7 17 *
<> 144:ef7eb2e8f9f7 18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
<> 144:ef7eb2e8f9f7 19 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
<> 144:ef7eb2e8f9f7 20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
<> 144:ef7eb2e8f9f7 21 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
<> 144:ef7eb2e8f9f7 22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
<> 144:ef7eb2e8f9f7 23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
<> 144:ef7eb2e8f9f7 24 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
<> 144:ef7eb2e8f9f7 25 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
<> 144:ef7eb2e8f9f7 26 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
<> 144:ef7eb2e8f9f7 27 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
<> 144:ef7eb2e8f9f7 28 *******************************************************************************
<> 144:ef7eb2e8f9f7 29 */
<> 144:ef7eb2e8f9f7 30 #include "mbed_assert.h"
<> 144:ef7eb2e8f9f7 31 #include "i2c_api.h"
<> 144:ef7eb2e8f9f7 32
<> 144:ef7eb2e8f9f7 33 #if DEVICE_I2C
<> 144:ef7eb2e8f9f7 34
<> 144:ef7eb2e8f9f7 35 #include "cmsis.h"
<> 144:ef7eb2e8f9f7 36 #include "pinmap.h"
<> 144:ef7eb2e8f9f7 37 #include "mbed_error.h"
<> 144:ef7eb2e8f9f7 38 #include "PeripheralPins.h"
<> 144:ef7eb2e8f9f7 39
<> 144:ef7eb2e8f9f7 40 /* Timeout values for flags and events waiting loops. These timeouts are
<> 144:ef7eb2e8f9f7 41 not based on accurate values, they just guarantee that the application will
<> 144:ef7eb2e8f9f7 42 not remain stuck if the I2C communication is corrupted. */
<> 144:ef7eb2e8f9f7 43 #define FLAG_TIMEOUT ((int)0x1000)
<> 144:ef7eb2e8f9f7 44 #define LONG_TIMEOUT ((int)0x8000)
<> 144:ef7eb2e8f9f7 45
<> 144:ef7eb2e8f9f7 46 I2C_HandleTypeDef I2cHandle;
<> 144:ef7eb2e8f9f7 47
<> 144:ef7eb2e8f9f7 48 void i2c_init(i2c_t *obj, PinName sda, PinName scl)
<> 144:ef7eb2e8f9f7 49 {
<> 144:ef7eb2e8f9f7 50 static int i2c1_inited = 0;
<> 144:ef7eb2e8f9f7 51 #if defined(I2C2_BASE)
<> 144:ef7eb2e8f9f7 52 static int i2c2_inited = 0;
<> 144:ef7eb2e8f9f7 53 #endif
<> 144:ef7eb2e8f9f7 54 #if defined(I2C3_BASE)
<> 144:ef7eb2e8f9f7 55 static int i2c3_inited = 0;
<> 144:ef7eb2e8f9f7 56 #endif
<> 144:ef7eb2e8f9f7 57
<> 144:ef7eb2e8f9f7 58 // Determine the I2C to use
<> 144:ef7eb2e8f9f7 59 I2CName i2c_sda = (I2CName)pinmap_peripheral(sda, PinMap_I2C_SDA);
<> 144:ef7eb2e8f9f7 60 I2CName i2c_scl = (I2CName)pinmap_peripheral(scl, PinMap_I2C_SCL);
<> 144:ef7eb2e8f9f7 61
<> 144:ef7eb2e8f9f7 62 obj->i2c = (I2CName)pinmap_merge(i2c_sda, i2c_scl);
<> 144:ef7eb2e8f9f7 63 MBED_ASSERT(obj->i2c != (I2CName)NC);
<> 144:ef7eb2e8f9f7 64
<> 144:ef7eb2e8f9f7 65 // Enable I2C1 clock and pinout if not done
<> 144:ef7eb2e8f9f7 66 if ((obj->i2c == I2C_1) && !i2c1_inited) {
<> 144:ef7eb2e8f9f7 67 i2c1_inited = 1;
<> 144:ef7eb2e8f9f7 68 __HAL_RCC_I2C1_CONFIG(RCC_I2C1CLKSOURCE_SYSCLK);
<> 144:ef7eb2e8f9f7 69 __HAL_RCC_I2C1_CLK_ENABLE();
<> 144:ef7eb2e8f9f7 70 // Configure I2C pins
<> 144:ef7eb2e8f9f7 71 pinmap_pinout(sda, PinMap_I2C_SDA);
<> 144:ef7eb2e8f9f7 72 pinmap_pinout(scl, PinMap_I2C_SCL);
<> 144:ef7eb2e8f9f7 73 pin_mode(sda, OpenDrain);
<> 144:ef7eb2e8f9f7 74 pin_mode(scl, OpenDrain);
<> 144:ef7eb2e8f9f7 75 }
<> 144:ef7eb2e8f9f7 76
<> 144:ef7eb2e8f9f7 77 #if defined(I2C2_BASE)
<> 144:ef7eb2e8f9f7 78 // Enable I2C2 clock and pinout if not done
<> 144:ef7eb2e8f9f7 79 if ((obj->i2c == I2C_2) && !i2c2_inited) {
<> 144:ef7eb2e8f9f7 80 i2c2_inited = 1;
<> 144:ef7eb2e8f9f7 81 __HAL_RCC_I2C2_CLK_ENABLE();
<> 144:ef7eb2e8f9f7 82 // Configure I2C pins
<> 144:ef7eb2e8f9f7 83 pinmap_pinout(sda, PinMap_I2C_SDA);
<> 144:ef7eb2e8f9f7 84 pinmap_pinout(scl, PinMap_I2C_SCL);
<> 144:ef7eb2e8f9f7 85 pin_mode(sda, OpenDrain);
<> 144:ef7eb2e8f9f7 86 pin_mode(scl, OpenDrain);
<> 144:ef7eb2e8f9f7 87 }
<> 144:ef7eb2e8f9f7 88 #endif
<> 144:ef7eb2e8f9f7 89
<> 144:ef7eb2e8f9f7 90 #if defined(I2C3_BASE)
<> 144:ef7eb2e8f9f7 91 // Enable I2C3 clock and pinout if not done
<> 144:ef7eb2e8f9f7 92 if ((obj->i2c == I2C_3) && !i2c3_inited) {
<> 144:ef7eb2e8f9f7 93 i2c3_inited = 1;
<> 144:ef7eb2e8f9f7 94 __HAL_RCC_I2C3_CLK_ENABLE();
<> 144:ef7eb2e8f9f7 95 // Configure I2C pins
<> 144:ef7eb2e8f9f7 96 pinmap_pinout(sda, PinMap_I2C_SDA);
<> 144:ef7eb2e8f9f7 97 pinmap_pinout(scl, PinMap_I2C_SCL);
<> 144:ef7eb2e8f9f7 98 pin_mode(sda, OpenDrain);
<> 144:ef7eb2e8f9f7 99 pin_mode(scl, OpenDrain);
<> 144:ef7eb2e8f9f7 100 }
<> 144:ef7eb2e8f9f7 101 #endif
<> 144:ef7eb2e8f9f7 102
<> 144:ef7eb2e8f9f7 103 // Reset to clear pending flags if any
<> 144:ef7eb2e8f9f7 104 i2c_reset(obj);
<> 144:ef7eb2e8f9f7 105
<> 144:ef7eb2e8f9f7 106 // I2C configuration
<> 144:ef7eb2e8f9f7 107 i2c_frequency(obj, 100000); // 100 kHz per default
<> 144:ef7eb2e8f9f7 108 }
<> 144:ef7eb2e8f9f7 109
<> 144:ef7eb2e8f9f7 110 void i2c_frequency(i2c_t *obj, int hz)
<> 144:ef7eb2e8f9f7 111 {
<> 144:ef7eb2e8f9f7 112 MBED_ASSERT((hz == 100000) || (hz == 400000) || (hz == 1000000));
<> 144:ef7eb2e8f9f7 113 I2cHandle.Instance = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 114 int timeout;
<> 144:ef7eb2e8f9f7 115
<> 144:ef7eb2e8f9f7 116 // wait before init
<> 144:ef7eb2e8f9f7 117 timeout = LONG_TIMEOUT;
<> 144:ef7eb2e8f9f7 118 while ((__HAL_I2C_GET_FLAG(&I2cHandle, I2C_FLAG_BUSY)) && (timeout-- != 0));
<> 144:ef7eb2e8f9f7 119
<> 144:ef7eb2e8f9f7 120 // Update the SystemCoreClock variable.
<> 144:ef7eb2e8f9f7 121 SystemCoreClockUpdate();
<> 144:ef7eb2e8f9f7 122
<> 144:ef7eb2e8f9f7 123 if (SystemCoreClock == 80000000) {
<> 144:ef7eb2e8f9f7 124 // Common settings: I2C clock = 80 MHz, Analog filter = ON, Digital filter coefficient = 0
<> 144:ef7eb2e8f9f7 125 switch (hz) {
<> 144:ef7eb2e8f9f7 126 case 100000:
<> 144:ef7eb2e8f9f7 127 I2cHandle.Init.Timing = 0x30C14E6B; // Standard mode with Rise Time = 400ns and Fall Time = 100ns
<> 144:ef7eb2e8f9f7 128 break;
<> 144:ef7eb2e8f9f7 129 case 400000:
<> 144:ef7eb2e8f9f7 130 I2cHandle.Init.Timing = 0x10D1143A; // Fast mode with Rise Time = 250ns and Fall Time = 100ns
<> 144:ef7eb2e8f9f7 131 break;
<> 144:ef7eb2e8f9f7 132 case 1000000:
<> 144:ef7eb2e8f9f7 133 I2cHandle.Init.Timing = 0x00810E27; // Fast mode Plus with Rise Time = 60ns and Fall Time = 100ns
<> 144:ef7eb2e8f9f7 134 break;
<> 144:ef7eb2e8f9f7 135 default:
<> 144:ef7eb2e8f9f7 136 break;
<> 144:ef7eb2e8f9f7 137 }
<> 144:ef7eb2e8f9f7 138 } else if (SystemCoreClock == 48000000) {
<> 144:ef7eb2e8f9f7 139 // Common settings: I2C clock = 48 MHz, Analog filter = ON, Digital filter coefficient = 0
<> 144:ef7eb2e8f9f7 140 switch (hz) {
<> 144:ef7eb2e8f9f7 141 case 100000:
<> 144:ef7eb2e8f9f7 142 I2cHandle.Init.Timing = 0x20A03E55; // Standard mode with Rise Time = 400ns and Fall Time = 100ns
<> 144:ef7eb2e8f9f7 143 break;
<> 144:ef7eb2e8f9f7 144 case 400000:
<> 144:ef7eb2e8f9f7 145 I2cHandle.Init.Timing = 0x10800C21; // Fast mode with Rise Time = 250ns and Fall Time = 100ns
<> 144:ef7eb2e8f9f7 146 break;
<> 144:ef7eb2e8f9f7 147 case 1000000:
<> 144:ef7eb2e8f9f7 148 I2cHandle.Init.Timing = 0x00500816; // Fast mode Plus with Rise Time = 60ns and Fall Time = 100ns
<> 144:ef7eb2e8f9f7 149 break;
<> 144:ef7eb2e8f9f7 150 default:
<> 144:ef7eb2e8f9f7 151 break;
<> 144:ef7eb2e8f9f7 152 }
<> 144:ef7eb2e8f9f7 153 }
<> 144:ef7eb2e8f9f7 154
<> 144:ef7eb2e8f9f7 155 // Enable the Fast Mode Plus capability
<> 144:ef7eb2e8f9f7 156 if (hz == 1000000) {
<> 144:ef7eb2e8f9f7 157 if (obj->i2c == I2C_1) {
<> 144:ef7eb2e8f9f7 158 __HAL_SYSCFG_FASTMODEPLUS_ENABLE(HAL_SYSCFG_FASTMODEPLUS_I2C1);
<> 144:ef7eb2e8f9f7 159 }
<> 144:ef7eb2e8f9f7 160 #if defined(I2C2_BASE)
<> 144:ef7eb2e8f9f7 161 if (obj->i2c == I2C_2) {
<> 144:ef7eb2e8f9f7 162 __HAL_SYSCFG_FASTMODEPLUS_ENABLE(HAL_SYSCFG_FASTMODEPLUS_I2C2);
<> 144:ef7eb2e8f9f7 163 }
<> 144:ef7eb2e8f9f7 164 #endif
<> 144:ef7eb2e8f9f7 165 #if defined(I2C3_BASE)
<> 144:ef7eb2e8f9f7 166 if (obj->i2c == I2C_3) {
<> 144:ef7eb2e8f9f7 167 __HAL_SYSCFG_FASTMODEPLUS_ENABLE(HAL_SYSCFG_FASTMODEPLUS_I2C3);
<> 144:ef7eb2e8f9f7 168 }
<> 144:ef7eb2e8f9f7 169 #endif
<> 144:ef7eb2e8f9f7 170 }
<> 144:ef7eb2e8f9f7 171
<> 144:ef7eb2e8f9f7 172
<> 144:ef7eb2e8f9f7 173 // I2C configuration
<> 144:ef7eb2e8f9f7 174 I2cHandle.Init.AddressingMode = I2C_ADDRESSINGMODE_7BIT;
<> 144:ef7eb2e8f9f7 175 I2cHandle.Init.DualAddressMode = I2C_DUALADDRESS_DISABLE;
<> 144:ef7eb2e8f9f7 176 I2cHandle.Init.GeneralCallMode = I2C_GENERALCALL_DISABLE;
<> 144:ef7eb2e8f9f7 177 I2cHandle.Init.NoStretchMode = I2C_NOSTRETCH_DISABLE;
<> 144:ef7eb2e8f9f7 178 I2cHandle.Init.OwnAddress1 = 0;
<> 144:ef7eb2e8f9f7 179 I2cHandle.Init.OwnAddress2 = 0;
<> 144:ef7eb2e8f9f7 180 I2cHandle.Init.OwnAddress2Masks = I2C_OA2_NOMASK;
<> 144:ef7eb2e8f9f7 181
<> 144:ef7eb2e8f9f7 182 if (HAL_I2C_Init(&I2cHandle) != HAL_OK) {
<> 144:ef7eb2e8f9f7 183 error("Cannot initialize I2C\n");
<> 144:ef7eb2e8f9f7 184 }
<> 144:ef7eb2e8f9f7 185 }
<> 144:ef7eb2e8f9f7 186
<> 144:ef7eb2e8f9f7 187 inline int i2c_start(i2c_t *obj)
<> 144:ef7eb2e8f9f7 188 {
<> 144:ef7eb2e8f9f7 189 I2C_TypeDef *i2c = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 190 int timeout;
<> 144:ef7eb2e8f9f7 191
<> 144:ef7eb2e8f9f7 192 I2cHandle.Instance = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 193
<> 144:ef7eb2e8f9f7 194 // Clear Acknowledge failure flag
<> 144:ef7eb2e8f9f7 195 __HAL_I2C_CLEAR_FLAG(&I2cHandle, I2C_FLAG_AF);
<> 144:ef7eb2e8f9f7 196
<> 144:ef7eb2e8f9f7 197 // Wait the STOP condition has been previously correctly sent
<> 144:ef7eb2e8f9f7 198 timeout = FLAG_TIMEOUT;
<> 144:ef7eb2e8f9f7 199 while ((i2c->CR2 & I2C_CR2_STOP) == I2C_CR2_STOP){
<> 144:ef7eb2e8f9f7 200 if ((timeout--) == 0) {
<> 144:ef7eb2e8f9f7 201 return 1;
<> 144:ef7eb2e8f9f7 202 }
<> 144:ef7eb2e8f9f7 203 }
<> 144:ef7eb2e8f9f7 204
<> 144:ef7eb2e8f9f7 205 // Generate the START condition
<> 144:ef7eb2e8f9f7 206 i2c->CR2 |= I2C_CR2_START;
<> 144:ef7eb2e8f9f7 207
<> 144:ef7eb2e8f9f7 208 // Wait the START condition has been correctly sent
<> 144:ef7eb2e8f9f7 209 timeout = FLAG_TIMEOUT;
<> 144:ef7eb2e8f9f7 210 while (__HAL_I2C_GET_FLAG(&I2cHandle, I2C_FLAG_BUSY) == RESET) {
<> 144:ef7eb2e8f9f7 211 if ((timeout--) == 0) {
<> 144:ef7eb2e8f9f7 212 return 1;
<> 144:ef7eb2e8f9f7 213 }
<> 144:ef7eb2e8f9f7 214 }
<> 144:ef7eb2e8f9f7 215
<> 144:ef7eb2e8f9f7 216 return 0;
<> 144:ef7eb2e8f9f7 217 }
<> 144:ef7eb2e8f9f7 218
<> 144:ef7eb2e8f9f7 219 inline int i2c_stop(i2c_t *obj)
<> 144:ef7eb2e8f9f7 220 {
<> 144:ef7eb2e8f9f7 221 I2C_TypeDef *i2c = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 222
<> 144:ef7eb2e8f9f7 223 // Generate the STOP condition
<> 144:ef7eb2e8f9f7 224 i2c->CR2 |= I2C_CR2_STOP;
<> 144:ef7eb2e8f9f7 225
<> 144:ef7eb2e8f9f7 226 return 0;
<> 144:ef7eb2e8f9f7 227 }
<> 144:ef7eb2e8f9f7 228
<> 144:ef7eb2e8f9f7 229 int i2c_read(i2c_t *obj, int address, char *data, int length, int stop)
<> 144:ef7eb2e8f9f7 230 {
<> 144:ef7eb2e8f9f7 231 I2C_TypeDef *i2c = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 232 I2cHandle.Instance = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 233 int timeout;
<> 144:ef7eb2e8f9f7 234 int count;
<> 144:ef7eb2e8f9f7 235 int value;
<> 144:ef7eb2e8f9f7 236
<> 144:ef7eb2e8f9f7 237 /* update CR2 register */
<> 144:ef7eb2e8f9f7 238 i2c->CR2 = (i2c->CR2 & (uint32_t)~((uint32_t)(I2C_CR2_SADD | I2C_CR2_NBYTES | I2C_CR2_RELOAD | I2C_CR2_AUTOEND | I2C_CR2_RD_WRN | I2C_CR2_START | I2C_CR2_STOP)))
<> 144:ef7eb2e8f9f7 239 | (uint32_t)(((uint32_t)address & I2C_CR2_SADD) | (((uint32_t)length << 16) & I2C_CR2_NBYTES) | (uint32_t)I2C_SOFTEND_MODE | (uint32_t)I2C_GENERATE_START_READ);
<> 144:ef7eb2e8f9f7 240
<> 144:ef7eb2e8f9f7 241 // Read all bytes
<> 144:ef7eb2e8f9f7 242 for (count = 0; count < length; count++) {
<> 144:ef7eb2e8f9f7 243 value = i2c_byte_read(obj, 0);
<> 144:ef7eb2e8f9f7 244 data[count] = (char)value;
<> 144:ef7eb2e8f9f7 245 }
<> 144:ef7eb2e8f9f7 246
<> 144:ef7eb2e8f9f7 247 // Wait transfer complete
<> 144:ef7eb2e8f9f7 248 timeout = FLAG_TIMEOUT;
<> 144:ef7eb2e8f9f7 249 while (__HAL_I2C_GET_FLAG(&I2cHandle, I2C_FLAG_TC) == RESET) {
<> 144:ef7eb2e8f9f7 250 timeout--;
<> 144:ef7eb2e8f9f7 251 if (timeout == 0) {
<> 144:ef7eb2e8f9f7 252 return -1;
<> 144:ef7eb2e8f9f7 253 }
<> 144:ef7eb2e8f9f7 254 }
<> 144:ef7eb2e8f9f7 255
<> 144:ef7eb2e8f9f7 256 __HAL_I2C_CLEAR_FLAG(&I2cHandle, I2C_FLAG_TC);
<> 144:ef7eb2e8f9f7 257
<> 144:ef7eb2e8f9f7 258 // If not repeated start, send stop.
<> 144:ef7eb2e8f9f7 259 if (stop) {
<> 144:ef7eb2e8f9f7 260 i2c_stop(obj);
<> 144:ef7eb2e8f9f7 261 /* Wait until STOPF flag is set */
<> 144:ef7eb2e8f9f7 262 timeout = FLAG_TIMEOUT;
<> 144:ef7eb2e8f9f7 263 while (__HAL_I2C_GET_FLAG(&I2cHandle, I2C_FLAG_STOPF) == RESET) {
<> 144:ef7eb2e8f9f7 264 timeout--;
<> 144:ef7eb2e8f9f7 265 if (timeout == 0) {
<> 144:ef7eb2e8f9f7 266 return -1;
<> 144:ef7eb2e8f9f7 267 }
<> 144:ef7eb2e8f9f7 268 }
<> 144:ef7eb2e8f9f7 269 /* Clear STOP Flag */
<> 144:ef7eb2e8f9f7 270 __HAL_I2C_CLEAR_FLAG(&I2cHandle, I2C_FLAG_STOPF);
<> 144:ef7eb2e8f9f7 271 }
<> 144:ef7eb2e8f9f7 272
<> 144:ef7eb2e8f9f7 273 return length;
<> 144:ef7eb2e8f9f7 274 }
<> 144:ef7eb2e8f9f7 275
<> 144:ef7eb2e8f9f7 276 int i2c_write(i2c_t *obj, int address, const char *data, int length, int stop)
<> 144:ef7eb2e8f9f7 277 {
<> 144:ef7eb2e8f9f7 278 I2C_TypeDef *i2c = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 279 I2cHandle.Instance = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 280 int timeout;
<> 144:ef7eb2e8f9f7 281 int count;
<> 144:ef7eb2e8f9f7 282
<> 144:ef7eb2e8f9f7 283 /* update CR2 register */
<> 144:ef7eb2e8f9f7 284 i2c->CR2 = (i2c->CR2 & (uint32_t)~((uint32_t)(I2C_CR2_SADD | I2C_CR2_NBYTES | I2C_CR2_RELOAD | I2C_CR2_AUTOEND | I2C_CR2_RD_WRN | I2C_CR2_START | I2C_CR2_STOP)))
<> 144:ef7eb2e8f9f7 285 | (uint32_t)(((uint32_t)address & I2C_CR2_SADD) | (((uint32_t)length << 16) & I2C_CR2_NBYTES) | (uint32_t)I2C_SOFTEND_MODE | (uint32_t)I2C_GENERATE_START_WRITE);
<> 144:ef7eb2e8f9f7 286
<> 144:ef7eb2e8f9f7 287 for (count = 0; count < length; count++) {
<> 144:ef7eb2e8f9f7 288 i2c_byte_write(obj, data[count]);
<> 144:ef7eb2e8f9f7 289 }
<> 144:ef7eb2e8f9f7 290
<> 144:ef7eb2e8f9f7 291 // Wait transfer complete
<> 144:ef7eb2e8f9f7 292 timeout = FLAG_TIMEOUT;
<> 144:ef7eb2e8f9f7 293 while (__HAL_I2C_GET_FLAG(&I2cHandle, I2C_FLAG_TC) == RESET) {
<> 144:ef7eb2e8f9f7 294 timeout--;
<> 144:ef7eb2e8f9f7 295 if (timeout == 0) {
<> 144:ef7eb2e8f9f7 296 return -1;
<> 144:ef7eb2e8f9f7 297 }
<> 144:ef7eb2e8f9f7 298 }
<> 144:ef7eb2e8f9f7 299
<> 144:ef7eb2e8f9f7 300 __HAL_I2C_CLEAR_FLAG(&I2cHandle, I2C_FLAG_TC);
<> 144:ef7eb2e8f9f7 301
<> 144:ef7eb2e8f9f7 302 // If not repeated start, send stop.
<> 144:ef7eb2e8f9f7 303 if (stop) {
<> 144:ef7eb2e8f9f7 304 i2c_stop(obj);
<> 144:ef7eb2e8f9f7 305 /* Wait until STOPF flag is set */
<> 144:ef7eb2e8f9f7 306 timeout = FLAG_TIMEOUT;
<> 144:ef7eb2e8f9f7 307 while (__HAL_I2C_GET_FLAG(&I2cHandle, I2C_FLAG_STOPF) == RESET) {
<> 144:ef7eb2e8f9f7 308 timeout--;
<> 144:ef7eb2e8f9f7 309 if (timeout == 0) {
<> 144:ef7eb2e8f9f7 310 return -1;
<> 144:ef7eb2e8f9f7 311 }
<> 144:ef7eb2e8f9f7 312 }
<> 144:ef7eb2e8f9f7 313 /* Clear STOP Flag */
<> 144:ef7eb2e8f9f7 314 __HAL_I2C_CLEAR_FLAG(&I2cHandle, I2C_FLAG_STOPF);
<> 144:ef7eb2e8f9f7 315 }
<> 144:ef7eb2e8f9f7 316
<> 144:ef7eb2e8f9f7 317 return count;
<> 144:ef7eb2e8f9f7 318 }
<> 144:ef7eb2e8f9f7 319
<> 144:ef7eb2e8f9f7 320 int i2c_byte_read(i2c_t *obj, int last)
<> 144:ef7eb2e8f9f7 321 {
<> 144:ef7eb2e8f9f7 322 I2C_TypeDef *i2c = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 323 int timeout;
<> 144:ef7eb2e8f9f7 324
<> 144:ef7eb2e8f9f7 325 // Wait until the byte is received
<> 144:ef7eb2e8f9f7 326 timeout = FLAG_TIMEOUT;
<> 144:ef7eb2e8f9f7 327 while (__HAL_I2C_GET_FLAG(&I2cHandle, I2C_FLAG_RXNE) == RESET) {
<> 144:ef7eb2e8f9f7 328 if ((timeout--) == 0) {
<> 144:ef7eb2e8f9f7 329 return -1;
<> 144:ef7eb2e8f9f7 330 }
<> 144:ef7eb2e8f9f7 331 }
<> 144:ef7eb2e8f9f7 332
<> 144:ef7eb2e8f9f7 333 return (int)i2c->RXDR;
<> 144:ef7eb2e8f9f7 334 }
<> 144:ef7eb2e8f9f7 335
<> 144:ef7eb2e8f9f7 336 int i2c_byte_write(i2c_t *obj, int data)
<> 144:ef7eb2e8f9f7 337 {
<> 144:ef7eb2e8f9f7 338 I2C_TypeDef *i2c = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 339 int timeout;
<> 144:ef7eb2e8f9f7 340
<> 144:ef7eb2e8f9f7 341 // Wait until the previous byte is transmitted
<> 144:ef7eb2e8f9f7 342 timeout = FLAG_TIMEOUT;
<> 144:ef7eb2e8f9f7 343 while (__HAL_I2C_GET_FLAG(&I2cHandle, I2C_FLAG_TXIS) == RESET) {
<> 144:ef7eb2e8f9f7 344 if ((timeout--) == 0) {
<> 144:ef7eb2e8f9f7 345 return 0;
<> 144:ef7eb2e8f9f7 346 }
<> 144:ef7eb2e8f9f7 347 }
<> 144:ef7eb2e8f9f7 348
<> 144:ef7eb2e8f9f7 349 i2c->TXDR = (uint8_t)data;
<> 144:ef7eb2e8f9f7 350
<> 144:ef7eb2e8f9f7 351 return 1;
<> 144:ef7eb2e8f9f7 352 }
<> 144:ef7eb2e8f9f7 353
<> 144:ef7eb2e8f9f7 354 void i2c_reset(i2c_t *obj)
<> 144:ef7eb2e8f9f7 355 {
<> 144:ef7eb2e8f9f7 356 int timeout;
<> 144:ef7eb2e8f9f7 357
<> 144:ef7eb2e8f9f7 358 // wait before reset
<> 144:ef7eb2e8f9f7 359 timeout = LONG_TIMEOUT;
<> 144:ef7eb2e8f9f7 360 while ((__HAL_I2C_GET_FLAG(&I2cHandle, I2C_FLAG_BUSY)) && (timeout-- != 0));
<> 144:ef7eb2e8f9f7 361
<> 144:ef7eb2e8f9f7 362 if (obj->i2c == I2C_1) {
<> 144:ef7eb2e8f9f7 363 __HAL_RCC_I2C1_FORCE_RESET();
<> 144:ef7eb2e8f9f7 364 __HAL_RCC_I2C1_RELEASE_RESET();
<> 144:ef7eb2e8f9f7 365 }
<> 144:ef7eb2e8f9f7 366 #if defined(I2C2_BASE)
<> 144:ef7eb2e8f9f7 367 if (obj->i2c == I2C_2) {
<> 144:ef7eb2e8f9f7 368 __HAL_RCC_I2C2_FORCE_RESET();
<> 144:ef7eb2e8f9f7 369 __HAL_RCC_I2C2_RELEASE_RESET();
<> 144:ef7eb2e8f9f7 370 }
<> 144:ef7eb2e8f9f7 371 #endif
<> 144:ef7eb2e8f9f7 372 }
<> 144:ef7eb2e8f9f7 373
<> 144:ef7eb2e8f9f7 374 #if DEVICE_I2CSLAVE
<> 144:ef7eb2e8f9f7 375
<> 144:ef7eb2e8f9f7 376 void i2c_slave_address(i2c_t *obj, int idx, uint32_t address, uint32_t mask)
<> 144:ef7eb2e8f9f7 377 {
<> 144:ef7eb2e8f9f7 378 I2C_TypeDef *i2c = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 379 uint16_t tmpreg;
<> 144:ef7eb2e8f9f7 380
<> 144:ef7eb2e8f9f7 381 // disable
<> 144:ef7eb2e8f9f7 382 i2c->OAR1 &= (uint32_t)(~I2C_OAR1_OA1EN);
<> 144:ef7eb2e8f9f7 383 // Get the old register value
<> 144:ef7eb2e8f9f7 384 tmpreg = i2c->OAR1;
<> 144:ef7eb2e8f9f7 385 // Reset address bits
<> 144:ef7eb2e8f9f7 386 tmpreg &= 0xFC00;
<> 144:ef7eb2e8f9f7 387 // Set new address
<> 144:ef7eb2e8f9f7 388 tmpreg |= (uint16_t)((uint16_t)address & (uint16_t)0x00FE); // 7-bits
<> 144:ef7eb2e8f9f7 389 // Store the new register value
<> 144:ef7eb2e8f9f7 390 i2c->OAR1 = tmpreg;
<> 144:ef7eb2e8f9f7 391 // enable
<> 144:ef7eb2e8f9f7 392 i2c->OAR1 |= I2C_OAR1_OA1EN;
<> 144:ef7eb2e8f9f7 393 }
<> 144:ef7eb2e8f9f7 394
<> 144:ef7eb2e8f9f7 395 void i2c_slave_mode(i2c_t *obj, int enable_slave)
<> 144:ef7eb2e8f9f7 396 {
<> 144:ef7eb2e8f9f7 397
<> 144:ef7eb2e8f9f7 398 I2C_TypeDef *i2c = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 399 uint16_t tmpreg;
<> 144:ef7eb2e8f9f7 400
<> 144:ef7eb2e8f9f7 401 // Get the old register value
<> 144:ef7eb2e8f9f7 402 tmpreg = i2c->OAR1;
<> 144:ef7eb2e8f9f7 403
<> 144:ef7eb2e8f9f7 404 // Enable / disable slave
<> 144:ef7eb2e8f9f7 405 if (enable_slave == 1) {
<> 144:ef7eb2e8f9f7 406 tmpreg |= I2C_OAR1_OA1EN;
<> 144:ef7eb2e8f9f7 407 } else {
<> 144:ef7eb2e8f9f7 408 tmpreg &= (uint32_t)(~I2C_OAR1_OA1EN);
<> 144:ef7eb2e8f9f7 409 }
<> 144:ef7eb2e8f9f7 410
<> 144:ef7eb2e8f9f7 411 // Set new mode
<> 144:ef7eb2e8f9f7 412 i2c->OAR1 = tmpreg;
<> 144:ef7eb2e8f9f7 413
<> 144:ef7eb2e8f9f7 414 }
<> 144:ef7eb2e8f9f7 415
<> 144:ef7eb2e8f9f7 416 // See I2CSlave.h
<> 144:ef7eb2e8f9f7 417 #define NoData 0 // the slave has not been addressed
<> 144:ef7eb2e8f9f7 418 #define ReadAddressed 1 // the master has requested a read from this slave (slave = transmitter)
<> 144:ef7eb2e8f9f7 419 #define WriteGeneral 2 // the master is writing to all slave
<> 144:ef7eb2e8f9f7 420 #define WriteAddressed 3 // the master is writing to this slave (slave = receiver)
<> 144:ef7eb2e8f9f7 421
<> 144:ef7eb2e8f9f7 422 int i2c_slave_receive(i2c_t *obj)
<> 144:ef7eb2e8f9f7 423 {
<> 144:ef7eb2e8f9f7 424 I2cHandle.Instance = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 425 int retValue = NoData;
<> 144:ef7eb2e8f9f7 426
<> 144:ef7eb2e8f9f7 427 if (__HAL_I2C_GET_FLAG(&I2cHandle, I2C_FLAG_BUSY) == 1) {
<> 144:ef7eb2e8f9f7 428 if (__HAL_I2C_GET_FLAG(&I2cHandle, I2C_FLAG_ADDR) == 1) {
<> 144:ef7eb2e8f9f7 429 if (__HAL_I2C_GET_FLAG(&I2cHandle, I2C_FLAG_DIR) == 1)
<> 144:ef7eb2e8f9f7 430 retValue = ReadAddressed;
<> 144:ef7eb2e8f9f7 431 else
<> 144:ef7eb2e8f9f7 432 retValue = WriteAddressed;
<> 144:ef7eb2e8f9f7 433 __HAL_I2C_CLEAR_FLAG(&I2cHandle, I2C_FLAG_ADDR);
<> 144:ef7eb2e8f9f7 434 }
<> 144:ef7eb2e8f9f7 435 }
<> 144:ef7eb2e8f9f7 436
<> 144:ef7eb2e8f9f7 437 return (retValue);
<> 144:ef7eb2e8f9f7 438 }
<> 144:ef7eb2e8f9f7 439
<> 144:ef7eb2e8f9f7 440 int i2c_slave_read(i2c_t *obj, char *data, int length)
<> 144:ef7eb2e8f9f7 441 {
<> 144:ef7eb2e8f9f7 442 char size = 0;
<> 144:ef7eb2e8f9f7 443
<> 144:ef7eb2e8f9f7 444 while (size < length) data[size++] = (char)i2c_byte_read(obj, 0);
<> 144:ef7eb2e8f9f7 445
<> 144:ef7eb2e8f9f7 446 return size;
<> 144:ef7eb2e8f9f7 447 }
<> 144:ef7eb2e8f9f7 448
<> 144:ef7eb2e8f9f7 449 int i2c_slave_write(i2c_t *obj, const char *data, int length)
<> 144:ef7eb2e8f9f7 450 {
<> 144:ef7eb2e8f9f7 451 char size = 0;
<> 144:ef7eb2e8f9f7 452 I2cHandle.Instance = (I2C_TypeDef *)(obj->i2c);
<> 144:ef7eb2e8f9f7 453
<> 144:ef7eb2e8f9f7 454 do {
<> 144:ef7eb2e8f9f7 455 i2c_byte_write(obj, data[size]);
<> 144:ef7eb2e8f9f7 456 size++;
<> 144:ef7eb2e8f9f7 457 } while (size < length);
<> 144:ef7eb2e8f9f7 458
<> 144:ef7eb2e8f9f7 459 return size;
<> 144:ef7eb2e8f9f7 460 }
<> 144:ef7eb2e8f9f7 461
<> 144:ef7eb2e8f9f7 462
<> 144:ef7eb2e8f9f7 463 #endif // DEVICE_I2CSLAVE
<> 144:ef7eb2e8f9f7 464
<> 144:ef7eb2e8f9f7 465 #endif // DEVICE_I2C