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