Gan likun
The prosthetic control（MIT）
targets/TARGET_STM/i2c_api.c@0:20e0c61e0684, 2022-06-23 (annotated)
- Committer:
- ganlikun
- Date:
- Thu Jun 23 05:23:34 2022 +0000
- Revision:
- 0:20e0c61e0684
01
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| ganlikun | 0:20e0c61e0684 | 1 | /* mbed Microcontroller Library |
| ganlikun | 0:20e0c61e0684 | 2 | ******************************************************************************* |
| ganlikun | 0:20e0c61e0684 | 3 | * Copyright (c) 2015, STMicroelectronics |
| ganlikun | 0:20e0c61e0684 | 4 | * All rights reserved. |
| ganlikun | 0:20e0c61e0684 | 5 | * |
| ganlikun | 0:20e0c61e0684 | 6 | * Redistribution and use in source and binary forms, with or without |
| ganlikun | 0:20e0c61e0684 | 7 | * modification, are permitted provided that the following conditions are met: |
| ganlikun | 0:20e0c61e0684 | 8 | * |
| ganlikun | 0:20e0c61e0684 | 9 | * 1. Redistributions of source code must retain the above copyright notice, |
| ganlikun | 0:20e0c61e0684 | 10 | * this list of conditions and the following disclaimer. |
| ganlikun | 0:20e0c61e0684 | 11 | * 2. Redistributions in binary form must reproduce the above copyright notice, |
| ganlikun | 0:20e0c61e0684 | 12 | * this list of conditions and the following disclaimer in the documentation |
| ganlikun | 0:20e0c61e0684 | 13 | * and/or other materials provided with the distribution. |
| ganlikun | 0:20e0c61e0684 | 14 | * 3. Neither the name of STMicroelectronics nor the names of its contributors |
| ganlikun | 0:20e0c61e0684 | 15 | * may be used to endorse or promote products derived from this software |
| ganlikun | 0:20e0c61e0684 | 16 | * without specific prior written permission. |
| ganlikun | 0:20e0c61e0684 | 17 | * |
| ganlikun | 0:20e0c61e0684 | 18 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| ganlikun | 0:20e0c61e0684 | 19 | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| ganlikun | 0:20e0c61e0684 | 20 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
| ganlikun | 0:20e0c61e0684 | 21 | * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE |
| ganlikun | 0:20e0c61e0684 | 22 | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
| ganlikun | 0:20e0c61e0684 | 23 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR |
| ganlikun | 0:20e0c61e0684 | 24 | * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER |
| ganlikun | 0:20e0c61e0684 | 25 | * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
| ganlikun | 0:20e0c61e0684 | 26 | * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
| ganlikun | 0:20e0c61e0684 | 27 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| ganlikun | 0:20e0c61e0684 | 28 | ******************************************************************************* |
| ganlikun | 0:20e0c61e0684 | 29 | */ |
| ganlikun | 0:20e0c61e0684 | 30 | |
| ganlikun | 0:20e0c61e0684 | 31 | |
| ganlikun | 0:20e0c61e0684 | 32 | #include "mbed_assert.h" |
| ganlikun | 0:20e0c61e0684 | 33 | #include "i2c_api.h" |
| ganlikun | 0:20e0c61e0684 | 34 | #include "platform/mbed_wait_api.h" |
| ganlikun | 0:20e0c61e0684 | 35 | |
| ganlikun | 0:20e0c61e0684 | 36 | #if DEVICE_I2C |
| ganlikun | 0:20e0c61e0684 | 37 | |
| ganlikun | 0:20e0c61e0684 | 38 | #include "cmsis.h" |
| ganlikun | 0:20e0c61e0684 | 39 | #include "pinmap.h" |
| ganlikun | 0:20e0c61e0684 | 40 | #include "PeripheralPins.h" |
| ganlikun | 0:20e0c61e0684 | 41 | #include "i2c_device.h" // family specific defines |
| ganlikun | 0:20e0c61e0684 | 42 | |
| ganlikun | 0:20e0c61e0684 | 43 | #ifndef DEBUG_STDIO |
| ganlikun | 0:20e0c61e0684 | 44 | # define DEBUG_STDIO 0 |
| ganlikun | 0:20e0c61e0684 | 45 | #endif |
| ganlikun | 0:20e0c61e0684 | 46 | |
| ganlikun | 0:20e0c61e0684 | 47 | #if DEBUG_STDIO |
| ganlikun | 0:20e0c61e0684 | 48 | # include <stdio.h> |
| ganlikun | 0:20e0c61e0684 | 49 | # define DEBUG_PRINTF(...) do { printf(__VA_ARGS__); } while(0) |
| ganlikun | 0:20e0c61e0684 | 50 | #else |
| ganlikun | 0:20e0c61e0684 | 51 | # define DEBUG_PRINTF(...) {} |
| ganlikun | 0:20e0c61e0684 | 52 | #endif |
| ganlikun | 0:20e0c61e0684 | 53 | |
| ganlikun | 0:20e0c61e0684 | 54 | #if DEVICE_I2C_ASYNCH |
| ganlikun | 0:20e0c61e0684 | 55 | #define I2C_S(obj) (struct i2c_s *) (&((obj)->i2c)) |
| ganlikun | 0:20e0c61e0684 | 56 | #else |
| ganlikun | 0:20e0c61e0684 | 57 | #define I2C_S(obj) (struct i2c_s *) (obj) |
| ganlikun | 0:20e0c61e0684 | 58 | #endif |
| ganlikun | 0:20e0c61e0684 | 59 | |
| ganlikun | 0:20e0c61e0684 | 60 | /* Family specific description for I2C */ |
| ganlikun | 0:20e0c61e0684 | 61 | #define I2C_NUM (5) |
| ganlikun | 0:20e0c61e0684 | 62 | static I2C_HandleTypeDef* i2c_handles[I2C_NUM]; |
| ganlikun | 0:20e0c61e0684 | 63 | |
| ganlikun | 0:20e0c61e0684 | 64 | /* Timeout values are based on core clock and I2C clock. |
| ganlikun | 0:20e0c61e0684 | 65 | The BYTE_TIMEOUT is computed as twice the number of cycles it would |
| ganlikun | 0:20e0c61e0684 | 66 | take to send 10 bits over I2C. Most Flags should take less than that. |
| ganlikun | 0:20e0c61e0684 | 67 | This is for immediate FLAG or ACK check. |
| ganlikun | 0:20e0c61e0684 | 68 | */ |
| ganlikun | 0:20e0c61e0684 | 69 | #define BYTE_TIMEOUT ((SystemCoreClock / obj_s->hz) * 2 * 10) |
| ganlikun | 0:20e0c61e0684 | 70 | /* Timeout values based on I2C clock. |
| ganlikun | 0:20e0c61e0684 | 71 | The BYTE_TIMEOUT_US is computed as 3x the time in us it would |
| ganlikun | 0:20e0c61e0684 | 72 | take to send 10 bits over I2C. Most Flags should take less than that. |
| ganlikun | 0:20e0c61e0684 | 73 | This is for complete transfers check. |
| ganlikun | 0:20e0c61e0684 | 74 | */ |
| ganlikun | 0:20e0c61e0684 | 75 | #define BYTE_TIMEOUT_US ((SystemCoreClock / obj_s->hz) * 3 * 10) |
| ganlikun | 0:20e0c61e0684 | 76 | /* Timeout values for flags and events waiting loops. These timeouts are |
| ganlikun | 0:20e0c61e0684 | 77 | not based on accurate values, they just guarantee that the application will |
| ganlikun | 0:20e0c61e0684 | 78 | not remain stuck if the I2C communication is corrupted. |
| ganlikun | 0:20e0c61e0684 | 79 | */ |
| ganlikun | 0:20e0c61e0684 | 80 | #define FLAG_TIMEOUT ((int)0x1000) |
| ganlikun | 0:20e0c61e0684 | 81 | |
| ganlikun | 0:20e0c61e0684 | 82 | /* GENERIC INIT and HELPERS FUNCTIONS */ |
| ganlikun | 0:20e0c61e0684 | 83 | |
| ganlikun | 0:20e0c61e0684 | 84 | #if defined(I2C1_BASE) |
| ganlikun | 0:20e0c61e0684 | 85 | static void i2c1_irq(void) |
| ganlikun | 0:20e0c61e0684 | 86 | { |
| ganlikun | 0:20e0c61e0684 | 87 | I2C_HandleTypeDef * handle = i2c_handles[0]; |
| ganlikun | 0:20e0c61e0684 | 88 | HAL_I2C_EV_IRQHandler(handle); |
| ganlikun | 0:20e0c61e0684 | 89 | HAL_I2C_ER_IRQHandler(handle); |
| ganlikun | 0:20e0c61e0684 | 90 | } |
| ganlikun | 0:20e0c61e0684 | 91 | #endif |
| ganlikun | 0:20e0c61e0684 | 92 | #if defined(I2C2_BASE) |
| ganlikun | 0:20e0c61e0684 | 93 | static void i2c2_irq(void) |
| ganlikun | 0:20e0c61e0684 | 94 | { |
| ganlikun | 0:20e0c61e0684 | 95 | I2C_HandleTypeDef * handle = i2c_handles[1]; |
| ganlikun | 0:20e0c61e0684 | 96 | HAL_I2C_EV_IRQHandler(handle); |
| ganlikun | 0:20e0c61e0684 | 97 | HAL_I2C_ER_IRQHandler(handle); |
| ganlikun | 0:20e0c61e0684 | 98 | } |
| ganlikun | 0:20e0c61e0684 | 99 | #endif |
| ganlikun | 0:20e0c61e0684 | 100 | #if defined(I2C3_BASE) |
| ganlikun | 0:20e0c61e0684 | 101 | static void i2c3_irq(void) |
| ganlikun | 0:20e0c61e0684 | 102 | { |
| ganlikun | 0:20e0c61e0684 | 103 | I2C_HandleTypeDef * handle = i2c_handles[2]; |
| ganlikun | 0:20e0c61e0684 | 104 | HAL_I2C_EV_IRQHandler(handle); |
| ganlikun | 0:20e0c61e0684 | 105 | HAL_I2C_ER_IRQHandler(handle); |
| ganlikun | 0:20e0c61e0684 | 106 | } |
| ganlikun | 0:20e0c61e0684 | 107 | #endif |
| ganlikun | 0:20e0c61e0684 | 108 | #if defined(I2C4_BASE) |
| ganlikun | 0:20e0c61e0684 | 109 | static void i2c4_irq(void) |
| ganlikun | 0:20e0c61e0684 | 110 | { |
| ganlikun | 0:20e0c61e0684 | 111 | I2C_HandleTypeDef * handle = i2c_handles[3]; |
| ganlikun | 0:20e0c61e0684 | 112 | HAL_I2C_EV_IRQHandler(handle); |
| ganlikun | 0:20e0c61e0684 | 113 | HAL_I2C_ER_IRQHandler(handle); |
| ganlikun | 0:20e0c61e0684 | 114 | } |
| ganlikun | 0:20e0c61e0684 | 115 | #endif |
| ganlikun | 0:20e0c61e0684 | 116 | #if defined(FMPI2C1_BASE) |
| ganlikun | 0:20e0c61e0684 | 117 | static void i2c5_irq(void) |
| ganlikun | 0:20e0c61e0684 | 118 | { |
| ganlikun | 0:20e0c61e0684 | 119 | I2C_HandleTypeDef * handle = i2c_handles[4]; |
| ganlikun | 0:20e0c61e0684 | 120 | HAL_I2C_EV_IRQHandler(handle); |
| ganlikun | 0:20e0c61e0684 | 121 | HAL_I2C_ER_IRQHandler(handle); |
| ganlikun | 0:20e0c61e0684 | 122 | } |
| ganlikun | 0:20e0c61e0684 | 123 | #endif |
| ganlikun | 0:20e0c61e0684 | 124 | |
| ganlikun | 0:20e0c61e0684 | 125 | void i2c_ev_err_enable(i2c_t *obj, uint32_t handler) { |
| ganlikun | 0:20e0c61e0684 | 126 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 127 | IRQn_Type irq_event_n = obj_s->event_i2cIRQ; |
| ganlikun | 0:20e0c61e0684 | 128 | IRQn_Type irq_error_n = obj_s->error_i2cIRQ; |
| ganlikun | 0:20e0c61e0684 | 129 | /* default prio in master case is set to 2 */ |
| ganlikun | 0:20e0c61e0684 | 130 | uint32_t prio = 2; |
| ganlikun | 0:20e0c61e0684 | 131 | |
| ganlikun | 0:20e0c61e0684 | 132 | /* Set up ITs using IRQ and handler tables */ |
| ganlikun | 0:20e0c61e0684 | 133 | NVIC_SetVector(irq_event_n, handler); |
| ganlikun | 0:20e0c61e0684 | 134 | NVIC_SetVector(irq_error_n, handler); |
| ganlikun | 0:20e0c61e0684 | 135 | |
| ganlikun | 0:20e0c61e0684 | 136 | #if DEVICE_I2CSLAVE |
| ganlikun | 0:20e0c61e0684 | 137 | /* Set higher priority to slave device than master. |
| ganlikun | 0:20e0c61e0684 | 138 | * In case a device makes use of both master and slave, the |
| ganlikun | 0:20e0c61e0684 | 139 | * slave needs higher responsiveness. |
| ganlikun | 0:20e0c61e0684 | 140 | */ |
| ganlikun | 0:20e0c61e0684 | 141 | if (obj_s->slave) { |
| ganlikun | 0:20e0c61e0684 | 142 | prio = 1; |
| ganlikun | 0:20e0c61e0684 | 143 | } |
| ganlikun | 0:20e0c61e0684 | 144 | #endif |
| ganlikun | 0:20e0c61e0684 | 145 | |
| ganlikun | 0:20e0c61e0684 | 146 | NVIC_SetPriority(irq_event_n, prio); |
| ganlikun | 0:20e0c61e0684 | 147 | NVIC_SetPriority(irq_error_n, prio); |
| ganlikun | 0:20e0c61e0684 | 148 | NVIC_EnableIRQ(irq_event_n); |
| ganlikun | 0:20e0c61e0684 | 149 | NVIC_EnableIRQ(irq_error_n); |
| ganlikun | 0:20e0c61e0684 | 150 | } |
| ganlikun | 0:20e0c61e0684 | 151 | |
| ganlikun | 0:20e0c61e0684 | 152 | void i2c_ev_err_disable(i2c_t *obj) { |
| ganlikun | 0:20e0c61e0684 | 153 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 154 | IRQn_Type irq_event_n = obj_s->event_i2cIRQ; |
| ganlikun | 0:20e0c61e0684 | 155 | IRQn_Type irq_error_n = obj_s->error_i2cIRQ; |
| ganlikun | 0:20e0c61e0684 | 156 | |
| ganlikun | 0:20e0c61e0684 | 157 | HAL_NVIC_DisableIRQ(irq_event_n); |
| ganlikun | 0:20e0c61e0684 | 158 | HAL_NVIC_DisableIRQ(irq_error_n); |
| ganlikun | 0:20e0c61e0684 | 159 | } |
| ganlikun | 0:20e0c61e0684 | 160 | |
| ganlikun | 0:20e0c61e0684 | 161 | uint32_t i2c_get_irq_handler(i2c_t *obj) |
| ganlikun | 0:20e0c61e0684 | 162 | { |
| ganlikun | 0:20e0c61e0684 | 163 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 164 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 165 | uint32_t handler = 0; |
| ganlikun | 0:20e0c61e0684 | 166 | |
| ganlikun | 0:20e0c61e0684 | 167 | switch (obj_s->index) { |
| ganlikun | 0:20e0c61e0684 | 168 | #if defined(I2C1_BASE) |
| ganlikun | 0:20e0c61e0684 | 169 | case 0: |
| ganlikun | 0:20e0c61e0684 | 170 | handler = (uint32_t)&i2c1_irq; |
| ganlikun | 0:20e0c61e0684 | 171 | break; |
| ganlikun | 0:20e0c61e0684 | 172 | #endif |
| ganlikun | 0:20e0c61e0684 | 173 | #if defined(I2C2_BASE) |
| ganlikun | 0:20e0c61e0684 | 174 | case 1: |
| ganlikun | 0:20e0c61e0684 | 175 | handler = (uint32_t)&i2c2_irq; |
| ganlikun | 0:20e0c61e0684 | 176 | break; |
| ganlikun | 0:20e0c61e0684 | 177 | #endif |
| ganlikun | 0:20e0c61e0684 | 178 | #if defined(I2C3_BASE) |
| ganlikun | 0:20e0c61e0684 | 179 | case 2: |
| ganlikun | 0:20e0c61e0684 | 180 | handler = (uint32_t)&i2c3_irq; |
| ganlikun | 0:20e0c61e0684 | 181 | break; |
| ganlikun | 0:20e0c61e0684 | 182 | #endif |
| ganlikun | 0:20e0c61e0684 | 183 | #if defined(I2C4_BASE) |
| ganlikun | 0:20e0c61e0684 | 184 | case 3: |
| ganlikun | 0:20e0c61e0684 | 185 | handler = (uint32_t)&i2c4_irq; |
| ganlikun | 0:20e0c61e0684 | 186 | break; |
| ganlikun | 0:20e0c61e0684 | 187 | #endif |
| ganlikun | 0:20e0c61e0684 | 188 | #if defined(FMPI2C1_BASE) |
| ganlikun | 0:20e0c61e0684 | 189 | case 4: |
| ganlikun | 0:20e0c61e0684 | 190 | handler = (uint32_t)&i2c5_irq; |
| ganlikun | 0:20e0c61e0684 | 191 | break; |
| ganlikun | 0:20e0c61e0684 | 192 | #endif |
| ganlikun | 0:20e0c61e0684 | 193 | } |
| ganlikun | 0:20e0c61e0684 | 194 | |
| ganlikun | 0:20e0c61e0684 | 195 | i2c_handles[obj_s->index] = handle; |
| ganlikun | 0:20e0c61e0684 | 196 | return handler; |
| ganlikun | 0:20e0c61e0684 | 197 | } |
| ganlikun | 0:20e0c61e0684 | 198 | |
| ganlikun | 0:20e0c61e0684 | 199 | void i2c_hw_reset(i2c_t *obj) { |
| ganlikun | 0:20e0c61e0684 | 200 | int timeout; |
| ganlikun | 0:20e0c61e0684 | 201 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 202 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 203 | |
| ganlikun | 0:20e0c61e0684 | 204 | handle->Instance = (I2C_TypeDef *)(obj_s->i2c); |
| ganlikun | 0:20e0c61e0684 | 205 | |
| ganlikun | 0:20e0c61e0684 | 206 | // wait before reset |
| ganlikun | 0:20e0c61e0684 | 207 | timeout = BYTE_TIMEOUT; |
| ganlikun | 0:20e0c61e0684 | 208 | while ((__HAL_I2C_GET_FLAG(handle, I2C_FLAG_BUSY)) && (--timeout != 0)); |
| ganlikun | 0:20e0c61e0684 | 209 | #if defined I2C1_BASE |
| ganlikun | 0:20e0c61e0684 | 210 | if (obj_s->i2c == I2C_1) { |
| ganlikun | 0:20e0c61e0684 | 211 | __HAL_RCC_I2C1_FORCE_RESET(); |
| ganlikun | 0:20e0c61e0684 | 212 | __HAL_RCC_I2C1_RELEASE_RESET(); |
| ganlikun | 0:20e0c61e0684 | 213 | } |
| ganlikun | 0:20e0c61e0684 | 214 | #endif |
| ganlikun | 0:20e0c61e0684 | 215 | #if defined I2C2_BASE |
| ganlikun | 0:20e0c61e0684 | 216 | if (obj_s->i2c == I2C_2) { |
| ganlikun | 0:20e0c61e0684 | 217 | __HAL_RCC_I2C2_FORCE_RESET(); |
| ganlikun | 0:20e0c61e0684 | 218 | __HAL_RCC_I2C2_RELEASE_RESET(); |
| ganlikun | 0:20e0c61e0684 | 219 | } |
| ganlikun | 0:20e0c61e0684 | 220 | #endif |
| ganlikun | 0:20e0c61e0684 | 221 | #if defined I2C3_BASE |
| ganlikun | 0:20e0c61e0684 | 222 | if (obj_s->i2c == I2C_3) { |
| ganlikun | 0:20e0c61e0684 | 223 | __HAL_RCC_I2C3_FORCE_RESET(); |
| ganlikun | 0:20e0c61e0684 | 224 | __HAL_RCC_I2C3_RELEASE_RESET(); |
| ganlikun | 0:20e0c61e0684 | 225 | } |
| ganlikun | 0:20e0c61e0684 | 226 | #endif |
| ganlikun | 0:20e0c61e0684 | 227 | #if defined I2C4_BASE |
| ganlikun | 0:20e0c61e0684 | 228 | if (obj_s->i2c == I2C_4) { |
| ganlikun | 0:20e0c61e0684 | 229 | __HAL_RCC_I2C4_FORCE_RESET(); |
| ganlikun | 0:20e0c61e0684 | 230 | __HAL_RCC_I2C4_RELEASE_RESET(); |
| ganlikun | 0:20e0c61e0684 | 231 | } |
| ganlikun | 0:20e0c61e0684 | 232 | #endif |
| ganlikun | 0:20e0c61e0684 | 233 | #if defined FMPI2C1_BASE |
| ganlikun | 0:20e0c61e0684 | 234 | if (obj_s->i2c == FMPI2C_1) { |
| ganlikun | 0:20e0c61e0684 | 235 | __HAL_RCC_FMPI2C1_FORCE_RESET(); |
| ganlikun | 0:20e0c61e0684 | 236 | __HAL_RCC_FMPI2C1_RELEASE_RESET(); |
| ganlikun | 0:20e0c61e0684 | 237 | } |
| ganlikun | 0:20e0c61e0684 | 238 | #endif |
| ganlikun | 0:20e0c61e0684 | 239 | } |
| ganlikun | 0:20e0c61e0684 | 240 | |
| ganlikun | 0:20e0c61e0684 | 241 | void i2c_sw_reset(i2c_t *obj) |
| ganlikun | 0:20e0c61e0684 | 242 | { |
| ganlikun | 0:20e0c61e0684 | 243 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 244 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 245 | /* SW reset procedure: |
| ganlikun | 0:20e0c61e0684 | 246 | * PE must be kept low during at least 3 APB clock cycles |
| ganlikun | 0:20e0c61e0684 | 247 | * in order to perform the software reset. |
| ganlikun | 0:20e0c61e0684 | 248 | * This is ensured by writing the following software sequence: |
| ganlikun | 0:20e0c61e0684 | 249 | * - Write PE=0 |
| ganlikun | 0:20e0c61e0684 | 250 | * - Check PE=0 |
| ganlikun | 0:20e0c61e0684 | 251 | * - Write PE=1. |
| ganlikun | 0:20e0c61e0684 | 252 | */ |
| ganlikun | 0:20e0c61e0684 | 253 | handle->Instance->CR1 &= ~I2C_CR1_PE; |
| ganlikun | 0:20e0c61e0684 | 254 | while(handle->Instance->CR1 & I2C_CR1_PE); |
| ganlikun | 0:20e0c61e0684 | 255 | handle->Instance->CR1 |= I2C_CR1_PE; |
| ganlikun | 0:20e0c61e0684 | 256 | } |
| ganlikun | 0:20e0c61e0684 | 257 | |
| ganlikun | 0:20e0c61e0684 | 258 | void i2c_init(i2c_t *obj, PinName sda, PinName scl) { |
| ganlikun | 0:20e0c61e0684 | 259 | |
| ganlikun | 0:20e0c61e0684 | 260 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 261 | |
| ganlikun | 0:20e0c61e0684 | 262 | // Determine the I2C to use |
| ganlikun | 0:20e0c61e0684 | 263 | I2CName i2c_sda = (I2CName)pinmap_peripheral(sda, PinMap_I2C_SDA); |
| ganlikun | 0:20e0c61e0684 | 264 | I2CName i2c_scl = (I2CName)pinmap_peripheral(scl, PinMap_I2C_SCL); |
| ganlikun | 0:20e0c61e0684 | 265 | obj_s->sda = sda; |
| ganlikun | 0:20e0c61e0684 | 266 | obj_s->scl = scl; |
| ganlikun | 0:20e0c61e0684 | 267 | |
| ganlikun | 0:20e0c61e0684 | 268 | obj_s->i2c = (I2CName)pinmap_merge(i2c_sda, i2c_scl); |
| ganlikun | 0:20e0c61e0684 | 269 | MBED_ASSERT(obj_s->i2c != (I2CName)NC); |
| ganlikun | 0:20e0c61e0684 | 270 | |
| ganlikun | 0:20e0c61e0684 | 271 | #if defined I2C1_BASE |
| ganlikun | 0:20e0c61e0684 | 272 | // Enable I2C1 clock and pinout if not done |
| ganlikun | 0:20e0c61e0684 | 273 | if (obj_s->i2c == I2C_1) { |
| ganlikun | 0:20e0c61e0684 | 274 | obj_s->index = 0; |
| ganlikun | 0:20e0c61e0684 | 275 | __HAL_RCC_I2C1_CLK_ENABLE(); |
| ganlikun | 0:20e0c61e0684 | 276 | // Configure I2C pins |
| ganlikun | 0:20e0c61e0684 | 277 | pinmap_pinout(sda, PinMap_I2C_SDA); |
| ganlikun | 0:20e0c61e0684 | 278 | pinmap_pinout(scl, PinMap_I2C_SCL); |
| ganlikun | 0:20e0c61e0684 | 279 | pin_mode(sda, OpenDrainPullUp); |
| ganlikun | 0:20e0c61e0684 | 280 | pin_mode(scl, OpenDrainPullUp); |
| ganlikun | 0:20e0c61e0684 | 281 | obj_s->event_i2cIRQ = I2C1_EV_IRQn; |
| ganlikun | 0:20e0c61e0684 | 282 | obj_s->error_i2cIRQ = I2C1_ER_IRQn; |
| ganlikun | 0:20e0c61e0684 | 283 | } |
| ganlikun | 0:20e0c61e0684 | 284 | #endif |
| ganlikun | 0:20e0c61e0684 | 285 | #if defined I2C2_BASE |
| ganlikun | 0:20e0c61e0684 | 286 | // Enable I2C2 clock and pinout if not done |
| ganlikun | 0:20e0c61e0684 | 287 | if (obj_s->i2c == I2C_2) { |
| ganlikun | 0:20e0c61e0684 | 288 | obj_s->index = 1; |
| ganlikun | 0:20e0c61e0684 | 289 | __HAL_RCC_I2C2_CLK_ENABLE(); |
| ganlikun | 0:20e0c61e0684 | 290 | // Configure I2C pins |
| ganlikun | 0:20e0c61e0684 | 291 | pinmap_pinout(sda, PinMap_I2C_SDA); |
| ganlikun | 0:20e0c61e0684 | 292 | pinmap_pinout(scl, PinMap_I2C_SCL); |
| ganlikun | 0:20e0c61e0684 | 293 | pin_mode(sda, OpenDrainPullUp); |
| ganlikun | 0:20e0c61e0684 | 294 | pin_mode(scl, OpenDrainPullUp); |
| ganlikun | 0:20e0c61e0684 | 295 | obj_s->event_i2cIRQ = I2C2_EV_IRQn; |
| ganlikun | 0:20e0c61e0684 | 296 | obj_s->error_i2cIRQ = I2C2_ER_IRQn; |
| ganlikun | 0:20e0c61e0684 | 297 | } |
| ganlikun | 0:20e0c61e0684 | 298 | #endif |
| ganlikun | 0:20e0c61e0684 | 299 | #if defined I2C3_BASE |
| ganlikun | 0:20e0c61e0684 | 300 | // Enable I2C3 clock and pinout if not done |
| ganlikun | 0:20e0c61e0684 | 301 | if (obj_s->i2c == I2C_3) { |
| ganlikun | 0:20e0c61e0684 | 302 | obj_s->index = 2; |
| ganlikun | 0:20e0c61e0684 | 303 | __HAL_RCC_I2C3_CLK_ENABLE(); |
| ganlikun | 0:20e0c61e0684 | 304 | // Configure I2C pins |
| ganlikun | 0:20e0c61e0684 | 305 | pinmap_pinout(sda, PinMap_I2C_SDA); |
| ganlikun | 0:20e0c61e0684 | 306 | pinmap_pinout(scl, PinMap_I2C_SCL); |
| ganlikun | 0:20e0c61e0684 | 307 | pin_mode(sda, OpenDrainPullUp); |
| ganlikun | 0:20e0c61e0684 | 308 | pin_mode(scl, OpenDrainPullUp); |
| ganlikun | 0:20e0c61e0684 | 309 | obj_s->event_i2cIRQ = I2C3_EV_IRQn; |
| ganlikun | 0:20e0c61e0684 | 310 | obj_s->error_i2cIRQ = I2C3_ER_IRQn; |
| ganlikun | 0:20e0c61e0684 | 311 | } |
| ganlikun | 0:20e0c61e0684 | 312 | #endif |
| ganlikun | 0:20e0c61e0684 | 313 | #if defined I2C4_BASE |
| ganlikun | 0:20e0c61e0684 | 314 | // Enable I2C3 clock and pinout if not done |
| ganlikun | 0:20e0c61e0684 | 315 | if (obj_s->i2c == I2C_4) { |
| ganlikun | 0:20e0c61e0684 | 316 | obj_s->index = 3; |
| ganlikun | 0:20e0c61e0684 | 317 | __HAL_RCC_I2C4_CLK_ENABLE(); |
| ganlikun | 0:20e0c61e0684 | 318 | // Configure I2C pins |
| ganlikun | 0:20e0c61e0684 | 319 | pinmap_pinout(sda, PinMap_I2C_SDA); |
| ganlikun | 0:20e0c61e0684 | 320 | pinmap_pinout(scl, PinMap_I2C_SCL); |
| ganlikun | 0:20e0c61e0684 | 321 | pin_mode(sda, OpenDrainPullUp); |
| ganlikun | 0:20e0c61e0684 | 322 | pin_mode(scl, OpenDrainPullUp); |
| ganlikun | 0:20e0c61e0684 | 323 | obj_s->event_i2cIRQ = I2C4_EV_IRQn; |
| ganlikun | 0:20e0c61e0684 | 324 | obj_s->error_i2cIRQ = I2C4_ER_IRQn; |
| ganlikun | 0:20e0c61e0684 | 325 | } |
| ganlikun | 0:20e0c61e0684 | 326 | #endif |
| ganlikun | 0:20e0c61e0684 | 327 | #if defined FMPI2C1_BASE |
| ganlikun | 0:20e0c61e0684 | 328 | // Enable I2C3 clock and pinout if not done |
| ganlikun | 0:20e0c61e0684 | 329 | if (obj_s->i2c == FMPI2C_1) { |
| ganlikun | 0:20e0c61e0684 | 330 | obj_s->index = 4; |
| ganlikun | 0:20e0c61e0684 | 331 | __HAL_RCC_FMPI2C1_CLK_ENABLE(); |
| ganlikun | 0:20e0c61e0684 | 332 | // Configure I2C pins |
| ganlikun | 0:20e0c61e0684 | 333 | pinmap_pinout(sda, PinMap_I2C_SDA); |
| ganlikun | 0:20e0c61e0684 | 334 | pinmap_pinout(scl, PinMap_I2C_SCL); |
| ganlikun | 0:20e0c61e0684 | 335 | pin_mode(sda, OpenDrainPullUp); |
| ganlikun | 0:20e0c61e0684 | 336 | pin_mode(scl, OpenDrainPullUp); |
| ganlikun | 0:20e0c61e0684 | 337 | obj_s->event_i2cIRQ = FMPI2C1_EV_IRQn; |
| ganlikun | 0:20e0c61e0684 | 338 | obj_s->error_i2cIRQ = FMPI2C1_ER_IRQn; |
| ganlikun | 0:20e0c61e0684 | 339 | } |
| ganlikun | 0:20e0c61e0684 | 340 | #endif |
| ganlikun | 0:20e0c61e0684 | 341 | |
| ganlikun | 0:20e0c61e0684 | 342 | // I2C configuration |
| ganlikun | 0:20e0c61e0684 | 343 | // Default hz value used for timeout computation |
| ganlikun | 0:20e0c61e0684 | 344 | if(!obj_s->hz) |
| ganlikun | 0:20e0c61e0684 | 345 | obj_s->hz = 100000; // 100 kHz per default |
| ganlikun | 0:20e0c61e0684 | 346 | |
| ganlikun | 0:20e0c61e0684 | 347 | // Reset to clear pending flags if any |
| ganlikun | 0:20e0c61e0684 | 348 | i2c_hw_reset(obj); |
| ganlikun | 0:20e0c61e0684 | 349 | i2c_frequency(obj, obj_s->hz ); |
| ganlikun | 0:20e0c61e0684 | 350 | |
| ganlikun | 0:20e0c61e0684 | 351 | #if DEVICE_I2CSLAVE |
| ganlikun | 0:20e0c61e0684 | 352 | // I2C master by default |
| ganlikun | 0:20e0c61e0684 | 353 | obj_s->slave = 0; |
| ganlikun | 0:20e0c61e0684 | 354 | obj_s->pending_slave_tx_master_rx = 0; |
| ganlikun | 0:20e0c61e0684 | 355 | obj_s->pending_slave_rx_maxter_tx = 0; |
| ganlikun | 0:20e0c61e0684 | 356 | #endif |
| ganlikun | 0:20e0c61e0684 | 357 | |
| ganlikun | 0:20e0c61e0684 | 358 | // I2C Xfer operation init |
| ganlikun | 0:20e0c61e0684 | 359 | obj_s->event = 0; |
| ganlikun | 0:20e0c61e0684 | 360 | obj_s->XferOperation = I2C_FIRST_AND_LAST_FRAME; |
| ganlikun | 0:20e0c61e0684 | 361 | #ifdef I2C_IP_VERSION_V2 |
| ganlikun | 0:20e0c61e0684 | 362 | obj_s->pending_start = 0; |
| ganlikun | 0:20e0c61e0684 | 363 | #endif |
| ganlikun | 0:20e0c61e0684 | 364 | } |
| ganlikun | 0:20e0c61e0684 | 365 | |
| ganlikun | 0:20e0c61e0684 | 366 | void i2c_frequency(i2c_t *obj, int hz) |
| ganlikun | 0:20e0c61e0684 | 367 | { |
| ganlikun | 0:20e0c61e0684 | 368 | int timeout; |
| ganlikun | 0:20e0c61e0684 | 369 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 370 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 371 | |
| ganlikun | 0:20e0c61e0684 | 372 | // wait before init |
| ganlikun | 0:20e0c61e0684 | 373 | timeout = BYTE_TIMEOUT; |
| ganlikun | 0:20e0c61e0684 | 374 | while ((__HAL_I2C_GET_FLAG(handle, I2C_FLAG_BUSY)) && (--timeout != 0)); |
| ganlikun | 0:20e0c61e0684 | 375 | |
| ganlikun | 0:20e0c61e0684 | 376 | #ifdef I2C_IP_VERSION_V1 |
| ganlikun | 0:20e0c61e0684 | 377 | handle->Init.ClockSpeed = hz; |
| ganlikun | 0:20e0c61e0684 | 378 | handle->Init.DutyCycle = I2C_DUTYCYCLE_2; |
| ganlikun | 0:20e0c61e0684 | 379 | #endif |
| ganlikun | 0:20e0c61e0684 | 380 | #ifdef I2C_IP_VERSION_V2 |
| ganlikun | 0:20e0c61e0684 | 381 | /* Only predefined timing for below frequencies are supported */ |
| ganlikun | 0:20e0c61e0684 | 382 | MBED_ASSERT((hz == 100000) || (hz == 400000) || (hz == 1000000)); |
| ganlikun | 0:20e0c61e0684 | 383 | handle->Init.Timing = get_i2c_timing(hz); |
| ganlikun | 0:20e0c61e0684 | 384 | |
| ganlikun | 0:20e0c61e0684 | 385 | // Enable the Fast Mode Plus capability |
| ganlikun | 0:20e0c61e0684 | 386 | if (hz == 1000000) { |
| ganlikun | 0:20e0c61e0684 | 387 | #if defined(I2C1_BASE) && defined(__HAL_SYSCFG_FASTMODEPLUS_ENABLE) && defined (I2C_FASTMODEPLUS_I2C1) |
| ganlikun | 0:20e0c61e0684 | 388 | if (obj_s->i2c == I2C_1) { |
| ganlikun | 0:20e0c61e0684 | 389 | HAL_I2CEx_EnableFastModePlus(I2C_FASTMODEPLUS_I2C1); |
| ganlikun | 0:20e0c61e0684 | 390 | } |
| ganlikun | 0:20e0c61e0684 | 391 | #endif |
| ganlikun | 0:20e0c61e0684 | 392 | #if defined(I2C2_BASE) && defined(__HAL_SYSCFG_FASTMODEPLUS_ENABLE) && defined (I2C_FASTMODEPLUS_I2C2) |
| ganlikun | 0:20e0c61e0684 | 393 | if (obj_s->i2c == I2C_2) { |
| ganlikun | 0:20e0c61e0684 | 394 | HAL_I2CEx_EnableFastModePlus(I2C_FASTMODEPLUS_I2C2); |
| ganlikun | 0:20e0c61e0684 | 395 | } |
| ganlikun | 0:20e0c61e0684 | 396 | #endif |
| ganlikun | 0:20e0c61e0684 | 397 | #if defined(I2C3_BASE) && defined(__HAL_SYSCFG_FASTMODEPLUS_ENABLE) && defined (I2C_FASTMODEPLUS_I2C3) |
| ganlikun | 0:20e0c61e0684 | 398 | if (obj_s->i2c == I2C_3) { |
| ganlikun | 0:20e0c61e0684 | 399 | HAL_I2CEx_EnableFastModePlus(I2C_FASTMODEPLUS_I2C3); |
| ganlikun | 0:20e0c61e0684 | 400 | } |
| ganlikun | 0:20e0c61e0684 | 401 | #endif |
| ganlikun | 0:20e0c61e0684 | 402 | #if defined(I2C4_BASE) && defined(__HAL_SYSCFG_FASTMODEPLUS_ENABLE) && defined (I2C_FASTMODEPLUS_I2C4) |
| ganlikun | 0:20e0c61e0684 | 403 | if (obj_s->i2c == I2C_4) { |
| ganlikun | 0:20e0c61e0684 | 404 | HAL_I2CEx_EnableFastModePlus(I2C_FASTMODEPLUS_I2C4); |
| ganlikun | 0:20e0c61e0684 | 405 | } |
| ganlikun | 0:20e0c61e0684 | 406 | #endif |
| ganlikun | 0:20e0c61e0684 | 407 | } |
| ganlikun | 0:20e0c61e0684 | 408 | #endif //I2C_IP_VERSION_V2 |
| ganlikun | 0:20e0c61e0684 | 409 | |
| ganlikun | 0:20e0c61e0684 | 410 | /*##-1- Configure the I2C clock source. The clock is derived from the SYSCLK #*/ |
| ganlikun | 0:20e0c61e0684 | 411 | #if defined(I2C1_BASE) && defined (__HAL_RCC_I2C1_CONFIG) |
| ganlikun | 0:20e0c61e0684 | 412 | if (obj_s->i2c == I2C_1) { |
| ganlikun | 0:20e0c61e0684 | 413 | __HAL_RCC_I2C1_CONFIG(I2CAPI_I2C1_CLKSRC); |
| ganlikun | 0:20e0c61e0684 | 414 | } |
| ganlikun | 0:20e0c61e0684 | 415 | #endif |
| ganlikun | 0:20e0c61e0684 | 416 | #if defined(I2C2_BASE) && defined(__HAL_RCC_I2C2_CONFIG) |
| ganlikun | 0:20e0c61e0684 | 417 | if (obj_s->i2c == I2C_2) { |
| ganlikun | 0:20e0c61e0684 | 418 | __HAL_RCC_I2C2_CONFIG(I2CAPI_I2C2_CLKSRC); |
| ganlikun | 0:20e0c61e0684 | 419 | } |
| ganlikun | 0:20e0c61e0684 | 420 | #endif |
| ganlikun | 0:20e0c61e0684 | 421 | #if defined(I2C3_BASE) && defined(__HAL_RCC_I2C3_CONFIG) |
| ganlikun | 0:20e0c61e0684 | 422 | if (obj_s->i2c == I2C_3) { |
| ganlikun | 0:20e0c61e0684 | 423 | __HAL_RCC_I2C3_CONFIG(I2CAPI_I2C3_CLKSRC); |
| ganlikun | 0:20e0c61e0684 | 424 | } |
| ganlikun | 0:20e0c61e0684 | 425 | #endif |
| ganlikun | 0:20e0c61e0684 | 426 | #if defined(I2C4_BASE) && defined(__HAL_RCC_I2C4_CONFIG) |
| ganlikun | 0:20e0c61e0684 | 427 | if (obj_s->i2c == I2C_4) { |
| ganlikun | 0:20e0c61e0684 | 428 | __HAL_RCC_I2C4_CONFIG(I2CAPI_I2C4_CLKSRC); |
| ganlikun | 0:20e0c61e0684 | 429 | } |
| ganlikun | 0:20e0c61e0684 | 430 | #endif |
| ganlikun | 0:20e0c61e0684 | 431 | |
| ganlikun | 0:20e0c61e0684 | 432 | #ifdef I2C_ANALOGFILTER_ENABLE |
| ganlikun | 0:20e0c61e0684 | 433 | /* Enable the Analog I2C Filter */ |
| ganlikun | 0:20e0c61e0684 | 434 | HAL_I2CEx_AnalogFilter_Config(handle,I2C_ANALOGFILTER_ENABLE); |
| ganlikun | 0:20e0c61e0684 | 435 | #endif |
| ganlikun | 0:20e0c61e0684 | 436 | |
| ganlikun | 0:20e0c61e0684 | 437 | // I2C configuration |
| ganlikun | 0:20e0c61e0684 | 438 | handle->Init.AddressingMode = I2C_ADDRESSINGMODE_7BIT; |
| ganlikun | 0:20e0c61e0684 | 439 | handle->Init.DualAddressMode = I2C_DUALADDRESS_DISABLE; |
| ganlikun | 0:20e0c61e0684 | 440 | handle->Init.GeneralCallMode = I2C_GENERALCALL_DISABLE; |
| ganlikun | 0:20e0c61e0684 | 441 | handle->Init.NoStretchMode = I2C_NOSTRETCH_DISABLE; |
| ganlikun | 0:20e0c61e0684 | 442 | handle->Init.OwnAddress1 = 0; |
| ganlikun | 0:20e0c61e0684 | 443 | handle->Init.OwnAddress2 = 0; |
| ganlikun | 0:20e0c61e0684 | 444 | HAL_I2C_Init(handle); |
| ganlikun | 0:20e0c61e0684 | 445 | |
| ganlikun | 0:20e0c61e0684 | 446 | /* store frequency for timeout computation */ |
| ganlikun | 0:20e0c61e0684 | 447 | obj_s->hz = hz; |
| ganlikun | 0:20e0c61e0684 | 448 | } |
| ganlikun | 0:20e0c61e0684 | 449 | |
| ganlikun | 0:20e0c61e0684 | 450 | i2c_t *get_i2c_obj(I2C_HandleTypeDef *hi2c){ |
| ganlikun | 0:20e0c61e0684 | 451 | /* Aim of the function is to get i2c_s pointer using hi2c pointer */ |
| ganlikun | 0:20e0c61e0684 | 452 | /* Highly inspired from magical linux kernel's "container_of" */ |
| ganlikun | 0:20e0c61e0684 | 453 | /* (which was not directly used since not compatible with IAR toolchain) */ |
| ganlikun | 0:20e0c61e0684 | 454 | struct i2c_s *obj_s; |
| ganlikun | 0:20e0c61e0684 | 455 | i2c_t *obj; |
| ganlikun | 0:20e0c61e0684 | 456 | |
| ganlikun | 0:20e0c61e0684 | 457 | obj_s = (struct i2c_s *)( (char *)hi2c - offsetof(struct i2c_s,handle)); |
| ganlikun | 0:20e0c61e0684 | 458 | obj = (i2c_t *)( (char *)obj_s - offsetof(i2c_t,i2c)); |
| ganlikun | 0:20e0c61e0684 | 459 | |
| ganlikun | 0:20e0c61e0684 | 460 | return (obj); |
| ganlikun | 0:20e0c61e0684 | 461 | } |
| ganlikun | 0:20e0c61e0684 | 462 | |
| ganlikun | 0:20e0c61e0684 | 463 | void i2c_reset(i2c_t *obj) { |
| ganlikun | 0:20e0c61e0684 | 464 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 465 | /* As recommended in i2c_api.h, mainly send stop */ |
| ganlikun | 0:20e0c61e0684 | 466 | i2c_stop(obj); |
| ganlikun | 0:20e0c61e0684 | 467 | /* then re-init */ |
| ganlikun | 0:20e0c61e0684 | 468 | i2c_init(obj, obj_s->sda, obj_s->scl); |
| ganlikun | 0:20e0c61e0684 | 469 | } |
| ganlikun | 0:20e0c61e0684 | 470 | |
| ganlikun | 0:20e0c61e0684 | 471 | /* |
| ganlikun | 0:20e0c61e0684 | 472 | * UNITARY APIS. |
| ganlikun | 0:20e0c61e0684 | 473 | * For very basic operations, direct registers access is needed |
| ganlikun | 0:20e0c61e0684 | 474 | * There are 2 different IPs version that need to be supported |
| ganlikun | 0:20e0c61e0684 | 475 | */ |
| ganlikun | 0:20e0c61e0684 | 476 | #ifdef I2C_IP_VERSION_V1 |
| ganlikun | 0:20e0c61e0684 | 477 | int i2c_start(i2c_t *obj) { |
| ganlikun | 0:20e0c61e0684 | 478 | |
| ganlikun | 0:20e0c61e0684 | 479 | int timeout; |
| ganlikun | 0:20e0c61e0684 | 480 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 481 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 482 | |
| ganlikun | 0:20e0c61e0684 | 483 | // Clear Acknowledge failure flag |
| ganlikun | 0:20e0c61e0684 | 484 | __HAL_I2C_CLEAR_FLAG(handle, I2C_FLAG_AF); |
| ganlikun | 0:20e0c61e0684 | 485 | |
| ganlikun | 0:20e0c61e0684 | 486 | // Wait the STOP condition has been previously correctly sent |
| ganlikun | 0:20e0c61e0684 | 487 | // This timeout can be avoid in some specific cases by simply clearing the STOP bit |
| ganlikun | 0:20e0c61e0684 | 488 | timeout = FLAG_TIMEOUT; |
| ganlikun | 0:20e0c61e0684 | 489 | while ((handle->Instance->CR1 & I2C_CR1_STOP) == I2C_CR1_STOP) { |
| ganlikun | 0:20e0c61e0684 | 490 | if ((timeout--) == 0) { |
| ganlikun | 0:20e0c61e0684 | 491 | return 1; |
| ganlikun | 0:20e0c61e0684 | 492 | } |
| ganlikun | 0:20e0c61e0684 | 493 | } |
| ganlikun | 0:20e0c61e0684 | 494 | |
| ganlikun | 0:20e0c61e0684 | 495 | // Generate the START condition |
| ganlikun | 0:20e0c61e0684 | 496 | handle->Instance->CR1 |= I2C_CR1_START; |
| ganlikun | 0:20e0c61e0684 | 497 | |
| ganlikun | 0:20e0c61e0684 | 498 | // Wait the START condition has been correctly sent |
| ganlikun | 0:20e0c61e0684 | 499 | timeout = FLAG_TIMEOUT; |
| ganlikun | 0:20e0c61e0684 | 500 | while (__HAL_I2C_GET_FLAG(handle, I2C_FLAG_SB) == RESET) { |
| ganlikun | 0:20e0c61e0684 | 501 | if ((timeout--) == 0) { |
| ganlikun | 0:20e0c61e0684 | 502 | return 1; |
| ganlikun | 0:20e0c61e0684 | 503 | } |
| ganlikun | 0:20e0c61e0684 | 504 | } |
| ganlikun | 0:20e0c61e0684 | 505 | |
| ganlikun | 0:20e0c61e0684 | 506 | return 0; |
| ganlikun | 0:20e0c61e0684 | 507 | } |
| ganlikun | 0:20e0c61e0684 | 508 | |
| ganlikun | 0:20e0c61e0684 | 509 | int i2c_stop(i2c_t *obj) { |
| ganlikun | 0:20e0c61e0684 | 510 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 511 | I2C_TypeDef *i2c = (I2C_TypeDef *)obj_s->i2c; |
| ganlikun | 0:20e0c61e0684 | 512 | |
| ganlikun | 0:20e0c61e0684 | 513 | // Generate the STOP condition |
| ganlikun | 0:20e0c61e0684 | 514 | i2c->CR1 |= I2C_CR1_STOP; |
| ganlikun | 0:20e0c61e0684 | 515 | |
| ganlikun | 0:20e0c61e0684 | 516 | /* In case of mixed usage of the APIs (unitary + SYNC) |
| ganlikun | 0:20e0c61e0684 | 517 | * re-init HAL state |
| ganlikun | 0:20e0c61e0684 | 518 | */ |
| ganlikun | 0:20e0c61e0684 | 519 | if(obj_s->XferOperation != I2C_FIRST_AND_LAST_FRAME) |
| ganlikun | 0:20e0c61e0684 | 520 | i2c_init(obj, obj_s->sda, obj_s->scl); |
| ganlikun | 0:20e0c61e0684 | 521 | |
| ganlikun | 0:20e0c61e0684 | 522 | return 0; |
| ganlikun | 0:20e0c61e0684 | 523 | } |
| ganlikun | 0:20e0c61e0684 | 524 | |
| ganlikun | 0:20e0c61e0684 | 525 | int i2c_byte_read(i2c_t *obj, int last) { |
| ganlikun | 0:20e0c61e0684 | 526 | |
| ganlikun | 0:20e0c61e0684 | 527 | int timeout; |
| ganlikun | 0:20e0c61e0684 | 528 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 529 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 530 | |
| ganlikun | 0:20e0c61e0684 | 531 | if (last) { |
| ganlikun | 0:20e0c61e0684 | 532 | // Don't acknowledge the last byte |
| ganlikun | 0:20e0c61e0684 | 533 | handle->Instance->CR1 &= ~I2C_CR1_ACK; |
| ganlikun | 0:20e0c61e0684 | 534 | } else { |
| ganlikun | 0:20e0c61e0684 | 535 | // Acknowledge the byte |
| ganlikun | 0:20e0c61e0684 | 536 | handle->Instance->CR1 |= I2C_CR1_ACK; |
| ganlikun | 0:20e0c61e0684 | 537 | } |
| ganlikun | 0:20e0c61e0684 | 538 | |
| ganlikun | 0:20e0c61e0684 | 539 | // Wait until the byte is received |
| ganlikun | 0:20e0c61e0684 | 540 | timeout = FLAG_TIMEOUT; |
| ganlikun | 0:20e0c61e0684 | 541 | while (__HAL_I2C_GET_FLAG(handle, I2C_FLAG_RXNE) == RESET) { |
| ganlikun | 0:20e0c61e0684 | 542 | if ((timeout--) == 0) { |
| ganlikun | 0:20e0c61e0684 | 543 | return -1; |
| ganlikun | 0:20e0c61e0684 | 544 | } |
| ganlikun | 0:20e0c61e0684 | 545 | } |
| ganlikun | 0:20e0c61e0684 | 546 | |
| ganlikun | 0:20e0c61e0684 | 547 | return (int)handle->Instance->DR; |
| ganlikun | 0:20e0c61e0684 | 548 | } |
| ganlikun | 0:20e0c61e0684 | 549 | |
| ganlikun | 0:20e0c61e0684 | 550 | int i2c_byte_write(i2c_t *obj, int data) { |
| ganlikun | 0:20e0c61e0684 | 551 | |
| ganlikun | 0:20e0c61e0684 | 552 | int timeout; |
| ganlikun | 0:20e0c61e0684 | 553 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 554 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 555 | |
| ganlikun | 0:20e0c61e0684 | 556 | handle->Instance->DR = (uint8_t)data; |
| ganlikun | 0:20e0c61e0684 | 557 | |
| ganlikun | 0:20e0c61e0684 | 558 | // Wait until the byte (might be the address) is transmitted |
| ganlikun | 0:20e0c61e0684 | 559 | timeout = FLAG_TIMEOUT; |
| ganlikun | 0:20e0c61e0684 | 560 | while ((__HAL_I2C_GET_FLAG(handle, I2C_FLAG_TXE) == RESET) && |
| ganlikun | 0:20e0c61e0684 | 561 | (__HAL_I2C_GET_FLAG(handle, I2C_FLAG_BTF) == RESET) && |
| ganlikun | 0:20e0c61e0684 | 562 | (__HAL_I2C_GET_FLAG(handle, I2C_FLAG_ADDR) == RESET)) { |
| ganlikun | 0:20e0c61e0684 | 563 | if ((timeout--) == 0) { |
| ganlikun | 0:20e0c61e0684 | 564 | return 2; |
| ganlikun | 0:20e0c61e0684 | 565 | } |
| ganlikun | 0:20e0c61e0684 | 566 | } |
| ganlikun | 0:20e0c61e0684 | 567 | |
| ganlikun | 0:20e0c61e0684 | 568 | if (__HAL_I2C_GET_FLAG(handle, I2C_FLAG_ADDR) != RESET) |
| ganlikun | 0:20e0c61e0684 | 569 | { |
| ganlikun | 0:20e0c61e0684 | 570 | __HAL_I2C_CLEAR_ADDRFLAG(handle); |
| ganlikun | 0:20e0c61e0684 | 571 | } |
| ganlikun | 0:20e0c61e0684 | 572 | |
| ganlikun | 0:20e0c61e0684 | 573 | return 1; |
| ganlikun | 0:20e0c61e0684 | 574 | } |
| ganlikun | 0:20e0c61e0684 | 575 | #endif //I2C_IP_VERSION_V1 |
| ganlikun | 0:20e0c61e0684 | 576 | #ifdef I2C_IP_VERSION_V2 |
| ganlikun | 0:20e0c61e0684 | 577 | |
| ganlikun | 0:20e0c61e0684 | 578 | int i2c_start(i2c_t *obj) { |
| ganlikun | 0:20e0c61e0684 | 579 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 580 | /* This I2C IP doesn't */ |
| ganlikun | 0:20e0c61e0684 | 581 | obj_s->pending_start = 1; |
| ganlikun | 0:20e0c61e0684 | 582 | return 0; |
| ganlikun | 0:20e0c61e0684 | 583 | } |
| ganlikun | 0:20e0c61e0684 | 584 | |
| ganlikun | 0:20e0c61e0684 | 585 | int i2c_stop(i2c_t *obj) { |
| ganlikun | 0:20e0c61e0684 | 586 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 587 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 588 | int timeout = FLAG_TIMEOUT; |
| ganlikun | 0:20e0c61e0684 | 589 | #if DEVICE_I2CSLAVE |
| ganlikun | 0:20e0c61e0684 | 590 | if (obj_s->slave) { |
| ganlikun | 0:20e0c61e0684 | 591 | /* re-init slave when stop is requested */ |
| ganlikun | 0:20e0c61e0684 | 592 | i2c_init(obj, obj_s->sda, obj_s->scl); |
| ganlikun | 0:20e0c61e0684 | 593 | return 0; |
| ganlikun | 0:20e0c61e0684 | 594 | } |
| ganlikun | 0:20e0c61e0684 | 595 | #endif |
| ganlikun | 0:20e0c61e0684 | 596 | // Disable reload mode |
| ganlikun | 0:20e0c61e0684 | 597 | handle->Instance->CR2 &= (uint32_t)~I2C_CR2_RELOAD; |
| ganlikun | 0:20e0c61e0684 | 598 | // Generate the STOP condition |
| ganlikun | 0:20e0c61e0684 | 599 | handle->Instance->CR2 |= I2C_CR2_STOP; |
| ganlikun | 0:20e0c61e0684 | 600 | |
| ganlikun | 0:20e0c61e0684 | 601 | timeout = FLAG_TIMEOUT; |
| ganlikun | 0:20e0c61e0684 | 602 | while (!__HAL_I2C_GET_FLAG(handle, I2C_FLAG_STOPF)) { |
| ganlikun | 0:20e0c61e0684 | 603 | if ((timeout--) == 0) { |
| ganlikun | 0:20e0c61e0684 | 604 | return I2C_ERROR_BUS_BUSY; |
| ganlikun | 0:20e0c61e0684 | 605 | } |
| ganlikun | 0:20e0c61e0684 | 606 | } |
| ganlikun | 0:20e0c61e0684 | 607 | |
| ganlikun | 0:20e0c61e0684 | 608 | /* Clear STOP Flag */ |
| ganlikun | 0:20e0c61e0684 | 609 | __HAL_I2C_CLEAR_FLAG(handle, I2C_FLAG_STOPF); |
| ganlikun | 0:20e0c61e0684 | 610 | |
| ganlikun | 0:20e0c61e0684 | 611 | /* Erase slave address, this wiil be used as a marker |
| ganlikun | 0:20e0c61e0684 | 612 | * to know when we need to prepare next start */ |
| ganlikun | 0:20e0c61e0684 | 613 | handle->Instance->CR2 &= ~I2C_CR2_SADD; |
| ganlikun | 0:20e0c61e0684 | 614 | |
| ganlikun | 0:20e0c61e0684 | 615 | /* |
| ganlikun | 0:20e0c61e0684 | 616 | * V2 IP is meant for automatic STOP, not user STOP |
| ganlikun | 0:20e0c61e0684 | 617 | * SW reset the IP state machine before next transaction |
| ganlikun | 0:20e0c61e0684 | 618 | */ |
| ganlikun | 0:20e0c61e0684 | 619 | i2c_sw_reset(obj); |
| ganlikun | 0:20e0c61e0684 | 620 | |
| ganlikun | 0:20e0c61e0684 | 621 | /* In case of mixed usage of the APIs (unitary + SYNC) |
| ganlikun | 0:20e0c61e0684 | 622 | * re-init HAL state */ |
| ganlikun | 0:20e0c61e0684 | 623 | if (obj_s->XferOperation != I2C_FIRST_AND_LAST_FRAME) { |
| ganlikun | 0:20e0c61e0684 | 624 | i2c_init(obj, obj_s->sda, obj_s->scl); |
| ganlikun | 0:20e0c61e0684 | 625 | } |
| ganlikun | 0:20e0c61e0684 | 626 | |
| ganlikun | 0:20e0c61e0684 | 627 | return 0; |
| ganlikun | 0:20e0c61e0684 | 628 | } |
| ganlikun | 0:20e0c61e0684 | 629 | |
| ganlikun | 0:20e0c61e0684 | 630 | int i2c_byte_read(i2c_t *obj, int last) { |
| ganlikun | 0:20e0c61e0684 | 631 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 632 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 633 | int timeout = FLAG_TIMEOUT; |
| ganlikun | 0:20e0c61e0684 | 634 | uint32_t tmpreg = handle->Instance->CR2; |
| ganlikun | 0:20e0c61e0684 | 635 | char data; |
| ganlikun | 0:20e0c61e0684 | 636 | #if DEVICE_I2CSLAVE |
| ganlikun | 0:20e0c61e0684 | 637 | if (obj_s->slave) { |
| ganlikun | 0:20e0c61e0684 | 638 | return i2c_slave_read(obj, &data, 1); |
| ganlikun | 0:20e0c61e0684 | 639 | } |
| ganlikun | 0:20e0c61e0684 | 640 | #endif |
| ganlikun | 0:20e0c61e0684 | 641 | /* Then send data when there's room in the TX fifo */ |
| ganlikun | 0:20e0c61e0684 | 642 | if ((tmpreg & I2C_CR2_RELOAD) != 0) { |
| ganlikun | 0:20e0c61e0684 | 643 | while (!__HAL_I2C_GET_FLAG(handle, I2C_FLAG_TCR)) { |
| ganlikun | 0:20e0c61e0684 | 644 | if ((timeout--) == 0) { |
| ganlikun | 0:20e0c61e0684 | 645 | DEBUG_PRINTF("timeout in byte_read\r\n"); |
| ganlikun | 0:20e0c61e0684 | 646 | return -1; |
| ganlikun | 0:20e0c61e0684 | 647 | } |
| ganlikun | 0:20e0c61e0684 | 648 | } |
| ganlikun | 0:20e0c61e0684 | 649 | } |
| ganlikun | 0:20e0c61e0684 | 650 | |
| ganlikun | 0:20e0c61e0684 | 651 | /* Enable reload mode as we don't know how many bytes will be sent */ |
| ganlikun | 0:20e0c61e0684 | 652 | /* and set transfer size to 1 */ |
| ganlikun | 0:20e0c61e0684 | 653 | tmpreg |= I2C_CR2_RELOAD | (I2C_CR2_NBYTES & (1 << 16)); |
| ganlikun | 0:20e0c61e0684 | 654 | /* Set the prepared configuration */ |
| ganlikun | 0:20e0c61e0684 | 655 | handle->Instance->CR2 = tmpreg; |
| ganlikun | 0:20e0c61e0684 | 656 | |
| ganlikun | 0:20e0c61e0684 | 657 | timeout = FLAG_TIMEOUT; |
| ganlikun | 0:20e0c61e0684 | 658 | while (!__HAL_I2C_GET_FLAG(handle, I2C_FLAG_RXNE)) { |
| ganlikun | 0:20e0c61e0684 | 659 | if ((timeout--) == 0) { |
| ganlikun | 0:20e0c61e0684 | 660 | return -1; |
| ganlikun | 0:20e0c61e0684 | 661 | } |
| ganlikun | 0:20e0c61e0684 | 662 | } |
| ganlikun | 0:20e0c61e0684 | 663 | |
| ganlikun | 0:20e0c61e0684 | 664 | /* Then Get Byte */ |
| ganlikun | 0:20e0c61e0684 | 665 | data = handle->Instance->RXDR; |
| ganlikun | 0:20e0c61e0684 | 666 | |
| ganlikun | 0:20e0c61e0684 | 667 | if (last) { |
| ganlikun | 0:20e0c61e0684 | 668 | /* Disable Address Acknowledge */ |
| ganlikun | 0:20e0c61e0684 | 669 | handle->Instance->CR2 |= I2C_CR2_NACK; |
| ganlikun | 0:20e0c61e0684 | 670 | } |
| ganlikun | 0:20e0c61e0684 | 671 | |
| ganlikun | 0:20e0c61e0684 | 672 | return data; |
| ganlikun | 0:20e0c61e0684 | 673 | } |
| ganlikun | 0:20e0c61e0684 | 674 | |
| ganlikun | 0:20e0c61e0684 | 675 | int i2c_byte_write(i2c_t *obj, int data) { |
| ganlikun | 0:20e0c61e0684 | 676 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 677 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 678 | int timeout = FLAG_TIMEOUT; |
| ganlikun | 0:20e0c61e0684 | 679 | uint32_t tmpreg = handle->Instance->CR2; |
| ganlikun | 0:20e0c61e0684 | 680 | #if DEVICE_I2CSLAVE |
| ganlikun | 0:20e0c61e0684 | 681 | if (obj_s->slave) { |
| ganlikun | 0:20e0c61e0684 | 682 | return i2c_slave_write(obj, (char *) &data, 1); |
| ganlikun | 0:20e0c61e0684 | 683 | } |
| ganlikun | 0:20e0c61e0684 | 684 | #endif |
| ganlikun | 0:20e0c61e0684 | 685 | if (obj_s->pending_start) { |
| ganlikun | 0:20e0c61e0684 | 686 | obj_s->pending_start = 0; |
| ganlikun | 0:20e0c61e0684 | 687 | //* First byte after the start is the address */ |
| ganlikun | 0:20e0c61e0684 | 688 | tmpreg |= (uint32_t)((uint32_t)data & I2C_CR2_SADD); |
| ganlikun | 0:20e0c61e0684 | 689 | if (data & 0x01) { |
| ganlikun | 0:20e0c61e0684 | 690 | tmpreg |= I2C_CR2_START | I2C_CR2_RD_WRN; |
| ganlikun | 0:20e0c61e0684 | 691 | } else { |
| ganlikun | 0:20e0c61e0684 | 692 | tmpreg |= I2C_CR2_START; |
| ganlikun | 0:20e0c61e0684 | 693 | tmpreg &= ~I2C_CR2_RD_WRN; |
| ganlikun | 0:20e0c61e0684 | 694 | } |
| ganlikun | 0:20e0c61e0684 | 695 | /* Disable reload first to use it later */ |
| ganlikun | 0:20e0c61e0684 | 696 | tmpreg &= ~I2C_CR2_RELOAD; |
| ganlikun | 0:20e0c61e0684 | 697 | /* Disable Autoend */ |
| ganlikun | 0:20e0c61e0684 | 698 | tmpreg &= ~I2C_CR2_AUTOEND; |
| ganlikun | 0:20e0c61e0684 | 699 | /* Do not set any transfer size for now */ |
| ganlikun | 0:20e0c61e0684 | 700 | tmpreg |= (I2C_CR2_NBYTES & (1 << 16)); |
| ganlikun | 0:20e0c61e0684 | 701 | /* Set the prepared configuration */ |
| ganlikun | 0:20e0c61e0684 | 702 | handle->Instance->CR2 = tmpreg; |
| ganlikun | 0:20e0c61e0684 | 703 | } else { |
| ganlikun | 0:20e0c61e0684 | 704 | /* Set the prepared configuration */ |
| ganlikun | 0:20e0c61e0684 | 705 | tmpreg = handle->Instance->CR2; |
| ganlikun | 0:20e0c61e0684 | 706 | |
| ganlikun | 0:20e0c61e0684 | 707 | /* Then send data when there's room in the TX fifo */ |
| ganlikun | 0:20e0c61e0684 | 708 | if ((tmpreg & I2C_CR2_RELOAD) != 0) { |
| ganlikun | 0:20e0c61e0684 | 709 | while (!__HAL_I2C_GET_FLAG(handle, I2C_FLAG_TCR)) { |
| ganlikun | 0:20e0c61e0684 | 710 | if ((timeout--) == 0) { |
| ganlikun | 0:20e0c61e0684 | 711 | DEBUG_PRINTF("timeout in byte_write\r\n"); |
| ganlikun | 0:20e0c61e0684 | 712 | return 2; |
| ganlikun | 0:20e0c61e0684 | 713 | } |
| ganlikun | 0:20e0c61e0684 | 714 | } |
| ganlikun | 0:20e0c61e0684 | 715 | } |
| ganlikun | 0:20e0c61e0684 | 716 | /* Enable reload mode as we don't know how many bytes will eb sent */ |
| ganlikun | 0:20e0c61e0684 | 717 | tmpreg |= I2C_CR2_RELOAD; |
| ganlikun | 0:20e0c61e0684 | 718 | /* Set transfer size to 1 */ |
| ganlikun | 0:20e0c61e0684 | 719 | tmpreg |= (I2C_CR2_NBYTES & (1 << 16)); |
| ganlikun | 0:20e0c61e0684 | 720 | /* Set the prepared configuration */ |
| ganlikun | 0:20e0c61e0684 | 721 | handle->Instance->CR2 = tmpreg; |
| ganlikun | 0:20e0c61e0684 | 722 | /* Prepare next write */ |
| ganlikun | 0:20e0c61e0684 | 723 | timeout = FLAG_TIMEOUT; |
| ganlikun | 0:20e0c61e0684 | 724 | while (!__HAL_I2C_GET_FLAG(handle, I2C_FLAG_TXE)) { |
| ganlikun | 0:20e0c61e0684 | 725 | if ((timeout--) == 0) { |
| ganlikun | 0:20e0c61e0684 | 726 | return 2; |
| ganlikun | 0:20e0c61e0684 | 727 | } |
| ganlikun | 0:20e0c61e0684 | 728 | } |
| ganlikun | 0:20e0c61e0684 | 729 | /* Write byte */ |
| ganlikun | 0:20e0c61e0684 | 730 | handle->Instance->TXDR = data; |
| ganlikun | 0:20e0c61e0684 | 731 | } |
| ganlikun | 0:20e0c61e0684 | 732 | |
| ganlikun | 0:20e0c61e0684 | 733 | return 1; |
| ganlikun | 0:20e0c61e0684 | 734 | } |
| ganlikun | 0:20e0c61e0684 | 735 | #endif //I2C_IP_VERSION_V2 |
| ganlikun | 0:20e0c61e0684 | 736 | |
| ganlikun | 0:20e0c61e0684 | 737 | /* |
| ganlikun | 0:20e0c61e0684 | 738 | * SYNC APIS |
| ganlikun | 0:20e0c61e0684 | 739 | */ |
| ganlikun | 0:20e0c61e0684 | 740 | int i2c_read(i2c_t *obj, int address, char *data, int length, int stop) { |
| ganlikun | 0:20e0c61e0684 | 741 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 742 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 743 | int count = I2C_ERROR_BUS_BUSY, ret = 0; |
| ganlikun | 0:20e0c61e0684 | 744 | uint32_t timeout = 0; |
| ganlikun | 0:20e0c61e0684 | 745 | |
| ganlikun | 0:20e0c61e0684 | 746 | if ((obj_s->XferOperation == I2C_FIRST_AND_LAST_FRAME) || |
| ganlikun | 0:20e0c61e0684 | 747 | (obj_s->XferOperation == I2C_LAST_FRAME)) { |
| ganlikun | 0:20e0c61e0684 | 748 | if (stop) |
| ganlikun | 0:20e0c61e0684 | 749 | obj_s->XferOperation = I2C_FIRST_AND_LAST_FRAME; |
| ganlikun | 0:20e0c61e0684 | 750 | else |
| ganlikun | 0:20e0c61e0684 | 751 | obj_s->XferOperation = I2C_FIRST_FRAME; |
| ganlikun | 0:20e0c61e0684 | 752 | } else if ((obj_s->XferOperation == I2C_FIRST_FRAME) || |
| ganlikun | 0:20e0c61e0684 | 753 | (obj_s->XferOperation == I2C_NEXT_FRAME)) { |
| ganlikun | 0:20e0c61e0684 | 754 | if (stop) |
| ganlikun | 0:20e0c61e0684 | 755 | obj_s->XferOperation = I2C_LAST_FRAME; |
| ganlikun | 0:20e0c61e0684 | 756 | else |
| ganlikun | 0:20e0c61e0684 | 757 | obj_s->XferOperation = I2C_NEXT_FRAME; |
| ganlikun | 0:20e0c61e0684 | 758 | } |
| ganlikun | 0:20e0c61e0684 | 759 | |
| ganlikun | 0:20e0c61e0684 | 760 | obj_s->event = 0; |
| ganlikun | 0:20e0c61e0684 | 761 | |
| ganlikun | 0:20e0c61e0684 | 762 | /* Activate default IRQ handlers for sync mode |
| ganlikun | 0:20e0c61e0684 | 763 | * which would be overwritten in async mode |
| ganlikun | 0:20e0c61e0684 | 764 | */ |
| ganlikun | 0:20e0c61e0684 | 765 | i2c_ev_err_enable(obj, i2c_get_irq_handler(obj)); |
| ganlikun | 0:20e0c61e0684 | 766 | |
| ganlikun | 0:20e0c61e0684 | 767 | ret = HAL_I2C_Master_Sequential_Receive_IT(handle, address, (uint8_t *) data, length, obj_s->XferOperation); |
| ganlikun | 0:20e0c61e0684 | 768 | |
| ganlikun | 0:20e0c61e0684 | 769 | if(ret == HAL_OK) { |
| ganlikun | 0:20e0c61e0684 | 770 | timeout = BYTE_TIMEOUT_US * (length + 1); |
| ganlikun | 0:20e0c61e0684 | 771 | /* transfer started : wait completion or timeout */ |
| ganlikun | 0:20e0c61e0684 | 772 | while(!(obj_s->event & I2C_EVENT_ALL) && (--timeout != 0)) { |
| ganlikun | 0:20e0c61e0684 | 773 | wait_us(1); |
| ganlikun | 0:20e0c61e0684 | 774 | } |
| ganlikun | 0:20e0c61e0684 | 775 | |
| ganlikun | 0:20e0c61e0684 | 776 | i2c_ev_err_disable(obj); |
| ganlikun | 0:20e0c61e0684 | 777 | |
| ganlikun | 0:20e0c61e0684 | 778 | if((timeout == 0) || (obj_s->event != I2C_EVENT_TRANSFER_COMPLETE)) { |
| ganlikun | 0:20e0c61e0684 | 779 | DEBUG_PRINTF(" TIMEOUT or error in i2c_read\r\n"); |
| ganlikun | 0:20e0c61e0684 | 780 | /* re-init IP to try and get back in a working state */ |
| ganlikun | 0:20e0c61e0684 | 781 | i2c_init(obj, obj_s->sda, obj_s->scl); |
| ganlikun | 0:20e0c61e0684 | 782 | } else { |
| ganlikun | 0:20e0c61e0684 | 783 | count = length; |
| ganlikun | 0:20e0c61e0684 | 784 | } |
| ganlikun | 0:20e0c61e0684 | 785 | } else { |
| ganlikun | 0:20e0c61e0684 | 786 | DEBUG_PRINTF("ERROR in i2c_read:%d\r\n", ret); |
| ganlikun | 0:20e0c61e0684 | 787 | } |
| ganlikun | 0:20e0c61e0684 | 788 | |
| ganlikun | 0:20e0c61e0684 | 789 | return count; |
| ganlikun | 0:20e0c61e0684 | 790 | } |
| ganlikun | 0:20e0c61e0684 | 791 | |
| ganlikun | 0:20e0c61e0684 | 792 | int i2c_write(i2c_t *obj, int address, const char *data, int length, int stop) { |
| ganlikun | 0:20e0c61e0684 | 793 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 794 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 795 | int count = I2C_ERROR_BUS_BUSY, ret = 0; |
| ganlikun | 0:20e0c61e0684 | 796 | uint32_t timeout = 0; |
| ganlikun | 0:20e0c61e0684 | 797 | |
| ganlikun | 0:20e0c61e0684 | 798 | if ((obj_s->XferOperation == I2C_FIRST_AND_LAST_FRAME) || |
| ganlikun | 0:20e0c61e0684 | 799 | (obj_s->XferOperation == I2C_LAST_FRAME)) { |
| ganlikun | 0:20e0c61e0684 | 800 | if (stop) |
| ganlikun | 0:20e0c61e0684 | 801 | obj_s->XferOperation = I2C_FIRST_AND_LAST_FRAME; |
| ganlikun | 0:20e0c61e0684 | 802 | else |
| ganlikun | 0:20e0c61e0684 | 803 | obj_s->XferOperation = I2C_FIRST_FRAME; |
| ganlikun | 0:20e0c61e0684 | 804 | } else if ((obj_s->XferOperation == I2C_FIRST_FRAME) || |
| ganlikun | 0:20e0c61e0684 | 805 | (obj_s->XferOperation == I2C_NEXT_FRAME)) { |
| ganlikun | 0:20e0c61e0684 | 806 | if (stop) |
| ganlikun | 0:20e0c61e0684 | 807 | obj_s->XferOperation = I2C_LAST_FRAME; |
| ganlikun | 0:20e0c61e0684 | 808 | else |
| ganlikun | 0:20e0c61e0684 | 809 | obj_s->XferOperation = I2C_NEXT_FRAME; |
| ganlikun | 0:20e0c61e0684 | 810 | } |
| ganlikun | 0:20e0c61e0684 | 811 | |
| ganlikun | 0:20e0c61e0684 | 812 | obj_s->event = 0; |
| ganlikun | 0:20e0c61e0684 | 813 | |
| ganlikun | 0:20e0c61e0684 | 814 | i2c_ev_err_enable(obj, i2c_get_irq_handler(obj)); |
| ganlikun | 0:20e0c61e0684 | 815 | |
| ganlikun | 0:20e0c61e0684 | 816 | ret = HAL_I2C_Master_Sequential_Transmit_IT(handle, address, (uint8_t *) data, length, obj_s->XferOperation); |
| ganlikun | 0:20e0c61e0684 | 817 | |
| ganlikun | 0:20e0c61e0684 | 818 | if(ret == HAL_OK) { |
| ganlikun | 0:20e0c61e0684 | 819 | timeout = BYTE_TIMEOUT_US * (length + 1); |
| ganlikun | 0:20e0c61e0684 | 820 | /* transfer started : wait completion or timeout */ |
| ganlikun | 0:20e0c61e0684 | 821 | while(!(obj_s->event & I2C_EVENT_ALL) && (--timeout != 0)) { |
| ganlikun | 0:20e0c61e0684 | 822 | wait_us(1); |
| ganlikun | 0:20e0c61e0684 | 823 | } |
| ganlikun | 0:20e0c61e0684 | 824 | |
| ganlikun | 0:20e0c61e0684 | 825 | i2c_ev_err_disable(obj); |
| ganlikun | 0:20e0c61e0684 | 826 | |
| ganlikun | 0:20e0c61e0684 | 827 | if((timeout == 0) || (obj_s->event != I2C_EVENT_TRANSFER_COMPLETE)) { |
| ganlikun | 0:20e0c61e0684 | 828 | DEBUG_PRINTF(" TIMEOUT or error in i2c_write\r\n"); |
| ganlikun | 0:20e0c61e0684 | 829 | /* re-init IP to try and get back in a working state */ |
| ganlikun | 0:20e0c61e0684 | 830 | i2c_init(obj, obj_s->sda, obj_s->scl); |
| ganlikun | 0:20e0c61e0684 | 831 | } else { |
| ganlikun | 0:20e0c61e0684 | 832 | count = length; |
| ganlikun | 0:20e0c61e0684 | 833 | } |
| ganlikun | 0:20e0c61e0684 | 834 | } else { |
| ganlikun | 0:20e0c61e0684 | 835 | DEBUG_PRINTF("ERROR in i2c_read\r\n"); |
| ganlikun | 0:20e0c61e0684 | 836 | } |
| ganlikun | 0:20e0c61e0684 | 837 | |
| ganlikun | 0:20e0c61e0684 | 838 | return count; |
| ganlikun | 0:20e0c61e0684 | 839 | } |
| ganlikun | 0:20e0c61e0684 | 840 | |
| ganlikun | 0:20e0c61e0684 | 841 | void HAL_I2C_MasterTxCpltCallback(I2C_HandleTypeDef *hi2c){ |
| ganlikun | 0:20e0c61e0684 | 842 | /* Get object ptr based on handler ptr */ |
| ganlikun | 0:20e0c61e0684 | 843 | i2c_t *obj = get_i2c_obj(hi2c); |
| ganlikun | 0:20e0c61e0684 | 844 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 845 | |
| ganlikun | 0:20e0c61e0684 | 846 | #if DEVICE_I2C_ASYNCH |
| ganlikun | 0:20e0c61e0684 | 847 | /* Handle potential Tx/Rx use case */ |
| ganlikun | 0:20e0c61e0684 | 848 | if ((obj->tx_buff.length) && (obj->rx_buff.length)) { |
| ganlikun | 0:20e0c61e0684 | 849 | if (obj_s->stop) { |
| ganlikun | 0:20e0c61e0684 | 850 | obj_s->XferOperation = I2C_LAST_FRAME; |
| ganlikun | 0:20e0c61e0684 | 851 | } else { |
| ganlikun | 0:20e0c61e0684 | 852 | obj_s->XferOperation = I2C_NEXT_FRAME; |
| ganlikun | 0:20e0c61e0684 | 853 | } |
| ganlikun | 0:20e0c61e0684 | 854 | |
| ganlikun | 0:20e0c61e0684 | 855 | HAL_I2C_Master_Sequential_Receive_IT(hi2c, obj_s->address, (uint8_t*)obj->rx_buff.buffer , obj->rx_buff.length, obj_s->XferOperation); |
| ganlikun | 0:20e0c61e0684 | 856 | } |
| ganlikun | 0:20e0c61e0684 | 857 | else |
| ganlikun | 0:20e0c61e0684 | 858 | #endif |
| ganlikun | 0:20e0c61e0684 | 859 | { |
| ganlikun | 0:20e0c61e0684 | 860 | /* Set event flag */ |
| ganlikun | 0:20e0c61e0684 | 861 | obj_s->event = I2C_EVENT_TRANSFER_COMPLETE; |
| ganlikun | 0:20e0c61e0684 | 862 | } |
| ganlikun | 0:20e0c61e0684 | 863 | } |
| ganlikun | 0:20e0c61e0684 | 864 | |
| ganlikun | 0:20e0c61e0684 | 865 | void HAL_I2C_MasterRxCpltCallback(I2C_HandleTypeDef *hi2c){ |
| ganlikun | 0:20e0c61e0684 | 866 | /* Get object ptr based on handler ptr */ |
| ganlikun | 0:20e0c61e0684 | 867 | i2c_t *obj = get_i2c_obj(hi2c); |
| ganlikun | 0:20e0c61e0684 | 868 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 869 | |
| ganlikun | 0:20e0c61e0684 | 870 | /* Set event flag */ |
| ganlikun | 0:20e0c61e0684 | 871 | obj_s->event = I2C_EVENT_TRANSFER_COMPLETE; |
| ganlikun | 0:20e0c61e0684 | 872 | } |
| ganlikun | 0:20e0c61e0684 | 873 | |
| ganlikun | 0:20e0c61e0684 | 874 | void HAL_I2C_ErrorCallback(I2C_HandleTypeDef *hi2c){ |
| ganlikun | 0:20e0c61e0684 | 875 | /* Get object ptr based on handler ptr */ |
| ganlikun | 0:20e0c61e0684 | 876 | i2c_t *obj = get_i2c_obj(hi2c); |
| ganlikun | 0:20e0c61e0684 | 877 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 878 | #if DEVICE_I2CSLAVE |
| ganlikun | 0:20e0c61e0684 | 879 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 880 | uint32_t address = 0; |
| ganlikun | 0:20e0c61e0684 | 881 | /* Store address to handle it after reset */ |
| ganlikun | 0:20e0c61e0684 | 882 | if(obj_s->slave) |
| ganlikun | 0:20e0c61e0684 | 883 | address = handle->Init.OwnAddress1; |
| ganlikun | 0:20e0c61e0684 | 884 | #endif |
| ganlikun | 0:20e0c61e0684 | 885 | |
| ganlikun | 0:20e0c61e0684 | 886 | DEBUG_PRINTF("HAL_I2C_ErrorCallback:%d, index=%d\r\n", (int) hi2c->ErrorCode, obj_s->index); |
| ganlikun | 0:20e0c61e0684 | 887 | |
| ganlikun | 0:20e0c61e0684 | 888 | /* re-init IP to try and get back in a working state */ |
| ganlikun | 0:20e0c61e0684 | 889 | i2c_init(obj, obj_s->sda, obj_s->scl); |
| ganlikun | 0:20e0c61e0684 | 890 | |
| ganlikun | 0:20e0c61e0684 | 891 | #if DEVICE_I2CSLAVE |
| ganlikun | 0:20e0c61e0684 | 892 | /* restore slave address */ |
| ganlikun | 0:20e0c61e0684 | 893 | if (address != 0) { |
| ganlikun | 0:20e0c61e0684 | 894 | obj_s->slave = 1; |
| ganlikun | 0:20e0c61e0684 | 895 | i2c_slave_address(obj, 0, address, 0); |
| ganlikun | 0:20e0c61e0684 | 896 | } |
| ganlikun | 0:20e0c61e0684 | 897 | #endif |
| ganlikun | 0:20e0c61e0684 | 898 | |
| ganlikun | 0:20e0c61e0684 | 899 | /* Keep Set event flag */ |
| ganlikun | 0:20e0c61e0684 | 900 | obj_s->event = I2C_EVENT_ERROR; |
| ganlikun | 0:20e0c61e0684 | 901 | } |
| ganlikun | 0:20e0c61e0684 | 902 | |
| ganlikun | 0:20e0c61e0684 | 903 | #if DEVICE_I2CSLAVE |
| ganlikun | 0:20e0c61e0684 | 904 | /* SLAVE API FUNCTIONS */ |
| ganlikun | 0:20e0c61e0684 | 905 | void i2c_slave_address(i2c_t *obj, int idx, uint32_t address, uint32_t mask) { |
| ganlikun | 0:20e0c61e0684 | 906 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 907 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 908 | |
| ganlikun | 0:20e0c61e0684 | 909 | // I2C configuration |
| ganlikun | 0:20e0c61e0684 | 910 | handle->Init.OwnAddress1 = address; |
| ganlikun | 0:20e0c61e0684 | 911 | HAL_I2C_Init(handle); |
| ganlikun | 0:20e0c61e0684 | 912 | |
| ganlikun | 0:20e0c61e0684 | 913 | i2c_ev_err_enable(obj, i2c_get_irq_handler(obj)); |
| ganlikun | 0:20e0c61e0684 | 914 | |
| ganlikun | 0:20e0c61e0684 | 915 | HAL_I2C_EnableListen_IT(handle); |
| ganlikun | 0:20e0c61e0684 | 916 | } |
| ganlikun | 0:20e0c61e0684 | 917 | |
| ganlikun | 0:20e0c61e0684 | 918 | void i2c_slave_mode(i2c_t *obj, int enable_slave) { |
| ganlikun | 0:20e0c61e0684 | 919 | |
| ganlikun | 0:20e0c61e0684 | 920 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 921 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 922 | |
| ganlikun | 0:20e0c61e0684 | 923 | if (enable_slave) { |
| ganlikun | 0:20e0c61e0684 | 924 | obj_s->slave = 1; |
| ganlikun | 0:20e0c61e0684 | 925 | HAL_I2C_EnableListen_IT(handle); |
| ganlikun | 0:20e0c61e0684 | 926 | } else { |
| ganlikun | 0:20e0c61e0684 | 927 | obj_s->slave = 0; |
| ganlikun | 0:20e0c61e0684 | 928 | HAL_I2C_DisableListen_IT(handle); |
| ganlikun | 0:20e0c61e0684 | 929 | } |
| ganlikun | 0:20e0c61e0684 | 930 | } |
| ganlikun | 0:20e0c61e0684 | 931 | |
| ganlikun | 0:20e0c61e0684 | 932 | // See I2CSlave.h |
| ganlikun | 0:20e0c61e0684 | 933 | #define NoData 0 // the slave has not been addressed |
| ganlikun | 0:20e0c61e0684 | 934 | #define ReadAddressed 1 // the master has requested a read from this slave (slave = transmitter) |
| ganlikun | 0:20e0c61e0684 | 935 | #define WriteGeneral 2 // the master is writing to all slave |
| ganlikun | 0:20e0c61e0684 | 936 | #define WriteAddressed 3 // the master is writing to this slave (slave = receiver) |
| ganlikun | 0:20e0c61e0684 | 937 | |
| ganlikun | 0:20e0c61e0684 | 938 | |
| ganlikun | 0:20e0c61e0684 | 939 | void HAL_I2C_AddrCallback(I2C_HandleTypeDef *hi2c, uint8_t TransferDirection, uint16_t AddrMatchCode) { |
| ganlikun | 0:20e0c61e0684 | 940 | /* Get object ptr based on handler ptr */ |
| ganlikun | 0:20e0c61e0684 | 941 | i2c_t *obj = get_i2c_obj(hi2c); |
| ganlikun | 0:20e0c61e0684 | 942 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 943 | |
| ganlikun | 0:20e0c61e0684 | 944 | /* Transfer direction in HAL is from Master point of view */ |
| ganlikun | 0:20e0c61e0684 | 945 | if(TransferDirection == I2C_DIRECTION_RECEIVE) { |
| ganlikun | 0:20e0c61e0684 | 946 | obj_s->pending_slave_tx_master_rx = 1; |
| ganlikun | 0:20e0c61e0684 | 947 | } |
| ganlikun | 0:20e0c61e0684 | 948 | |
| ganlikun | 0:20e0c61e0684 | 949 | if(TransferDirection == I2C_DIRECTION_TRANSMIT) { |
| ganlikun | 0:20e0c61e0684 | 950 | obj_s->pending_slave_rx_maxter_tx = 1; |
| ganlikun | 0:20e0c61e0684 | 951 | } |
| ganlikun | 0:20e0c61e0684 | 952 | } |
| ganlikun | 0:20e0c61e0684 | 953 | |
| ganlikun | 0:20e0c61e0684 | 954 | void HAL_I2C_SlaveTxCpltCallback(I2C_HandleTypeDef *I2cHandle){ |
| ganlikun | 0:20e0c61e0684 | 955 | /* Get object ptr based on handler ptr */ |
| ganlikun | 0:20e0c61e0684 | 956 | i2c_t *obj = get_i2c_obj(I2cHandle); |
| ganlikun | 0:20e0c61e0684 | 957 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 958 | obj_s->pending_slave_tx_master_rx = 0; |
| ganlikun | 0:20e0c61e0684 | 959 | } |
| ganlikun | 0:20e0c61e0684 | 960 | |
| ganlikun | 0:20e0c61e0684 | 961 | void HAL_I2C_SlaveRxCpltCallback(I2C_HandleTypeDef *I2cHandle){ |
| ganlikun | 0:20e0c61e0684 | 962 | /* Get object ptr based on handler ptr */ |
| ganlikun | 0:20e0c61e0684 | 963 | i2c_t *obj = get_i2c_obj(I2cHandle); |
| ganlikun | 0:20e0c61e0684 | 964 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 965 | obj_s->pending_slave_rx_maxter_tx = 0; |
| ganlikun | 0:20e0c61e0684 | 966 | } |
| ganlikun | 0:20e0c61e0684 | 967 | |
| ganlikun | 0:20e0c61e0684 | 968 | void HAL_I2C_ListenCpltCallback(I2C_HandleTypeDef *hi2c) |
| ganlikun | 0:20e0c61e0684 | 969 | { |
| ganlikun | 0:20e0c61e0684 | 970 | /* restart listening for master requests */ |
| ganlikun | 0:20e0c61e0684 | 971 | HAL_I2C_EnableListen_IT(hi2c); |
| ganlikun | 0:20e0c61e0684 | 972 | } |
| ganlikun | 0:20e0c61e0684 | 973 | |
| ganlikun | 0:20e0c61e0684 | 974 | int i2c_slave_receive(i2c_t *obj) { |
| ganlikun | 0:20e0c61e0684 | 975 | |
| ganlikun | 0:20e0c61e0684 | 976 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 977 | int retValue = NoData; |
| ganlikun | 0:20e0c61e0684 | 978 | |
| ganlikun | 0:20e0c61e0684 | 979 | if(obj_s->pending_slave_rx_maxter_tx) { |
| ganlikun | 0:20e0c61e0684 | 980 | retValue = WriteAddressed; |
| ganlikun | 0:20e0c61e0684 | 981 | } |
| ganlikun | 0:20e0c61e0684 | 982 | |
| ganlikun | 0:20e0c61e0684 | 983 | if(obj_s->pending_slave_tx_master_rx) { |
| ganlikun | 0:20e0c61e0684 | 984 | retValue = ReadAddressed; |
| ganlikun | 0:20e0c61e0684 | 985 | } |
| ganlikun | 0:20e0c61e0684 | 986 | |
| ganlikun | 0:20e0c61e0684 | 987 | return (retValue); |
| ganlikun | 0:20e0c61e0684 | 988 | } |
| ganlikun | 0:20e0c61e0684 | 989 | |
| ganlikun | 0:20e0c61e0684 | 990 | int i2c_slave_read(i2c_t *obj, char *data, int length) { |
| ganlikun | 0:20e0c61e0684 | 991 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 992 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 993 | int count = 0; |
| ganlikun | 0:20e0c61e0684 | 994 | int ret = 0; |
| ganlikun | 0:20e0c61e0684 | 995 | uint32_t timeout = 0; |
| ganlikun | 0:20e0c61e0684 | 996 | |
| ganlikun | 0:20e0c61e0684 | 997 | /* Always use I2C_NEXT_FRAME as slave will just adapt to master requests */ |
| ganlikun | 0:20e0c61e0684 | 998 | ret = HAL_I2C_Slave_Sequential_Receive_IT(handle, (uint8_t *) data, length, I2C_NEXT_FRAME); |
| ganlikun | 0:20e0c61e0684 | 999 | |
| ganlikun | 0:20e0c61e0684 | 1000 | if(ret == HAL_OK) { |
| ganlikun | 0:20e0c61e0684 | 1001 | timeout = BYTE_TIMEOUT_US * (length + 1); |
| ganlikun | 0:20e0c61e0684 | 1002 | while(obj_s->pending_slave_rx_maxter_tx && (--timeout != 0)) { |
| ganlikun | 0:20e0c61e0684 | 1003 | wait_us(1); |
| ganlikun | 0:20e0c61e0684 | 1004 | } |
| ganlikun | 0:20e0c61e0684 | 1005 | |
| ganlikun | 0:20e0c61e0684 | 1006 | if(timeout != 0) { |
| ganlikun | 0:20e0c61e0684 | 1007 | count = length; |
| ganlikun | 0:20e0c61e0684 | 1008 | } else { |
| ganlikun | 0:20e0c61e0684 | 1009 | DEBUG_PRINTF("TIMEOUT or error in i2c_slave_read\r\n"); |
| ganlikun | 0:20e0c61e0684 | 1010 | } |
| ganlikun | 0:20e0c61e0684 | 1011 | } |
| ganlikun | 0:20e0c61e0684 | 1012 | return count; |
| ganlikun | 0:20e0c61e0684 | 1013 | } |
| ganlikun | 0:20e0c61e0684 | 1014 | |
| ganlikun | 0:20e0c61e0684 | 1015 | int i2c_slave_write(i2c_t *obj, const char *data, int length) { |
| ganlikun | 0:20e0c61e0684 | 1016 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 1017 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 1018 | int count = 0; |
| ganlikun | 0:20e0c61e0684 | 1019 | int ret = 0; |
| ganlikun | 0:20e0c61e0684 | 1020 | uint32_t timeout = 0; |
| ganlikun | 0:20e0c61e0684 | 1021 | |
| ganlikun | 0:20e0c61e0684 | 1022 | /* Always use I2C_NEXT_FRAME as slave will just adapt to master requests */ |
| ganlikun | 0:20e0c61e0684 | 1023 | ret = HAL_I2C_Slave_Sequential_Transmit_IT(handle, (uint8_t *) data, length, I2C_NEXT_FRAME); |
| ganlikun | 0:20e0c61e0684 | 1024 | |
| ganlikun | 0:20e0c61e0684 | 1025 | if(ret == HAL_OK) { |
| ganlikun | 0:20e0c61e0684 | 1026 | timeout = BYTE_TIMEOUT_US * (length + 1); |
| ganlikun | 0:20e0c61e0684 | 1027 | while(obj_s->pending_slave_tx_master_rx && (--timeout != 0)) { |
| ganlikun | 0:20e0c61e0684 | 1028 | wait_us(1); |
| ganlikun | 0:20e0c61e0684 | 1029 | } |
| ganlikun | 0:20e0c61e0684 | 1030 | |
| ganlikun | 0:20e0c61e0684 | 1031 | if(timeout != 0) { |
| ganlikun | 0:20e0c61e0684 | 1032 | count = length; |
| ganlikun | 0:20e0c61e0684 | 1033 | } else { |
| ganlikun | 0:20e0c61e0684 | 1034 | DEBUG_PRINTF("TIMEOUT or error in i2c_slave_write\r\n"); |
| ganlikun | 0:20e0c61e0684 | 1035 | } |
| ganlikun | 0:20e0c61e0684 | 1036 | } |
| ganlikun | 0:20e0c61e0684 | 1037 | |
| ganlikun | 0:20e0c61e0684 | 1038 | return count; |
| ganlikun | 0:20e0c61e0684 | 1039 | } |
| ganlikun | 0:20e0c61e0684 | 1040 | #endif // DEVICE_I2CSLAVE |
| ganlikun | 0:20e0c61e0684 | 1041 | |
| ganlikun | 0:20e0c61e0684 | 1042 | #if DEVICE_I2C_ASYNCH |
| ganlikun | 0:20e0c61e0684 | 1043 | /* ASYNCH MASTER API FUNCTIONS */ |
| ganlikun | 0:20e0c61e0684 | 1044 | void HAL_I2C_AbortCpltCallback(I2C_HandleTypeDef *hi2c){ |
| ganlikun | 0:20e0c61e0684 | 1045 | /* Get object ptr based on handler ptr */ |
| ganlikun | 0:20e0c61e0684 | 1046 | i2c_t *obj = get_i2c_obj(hi2c); |
| ganlikun | 0:20e0c61e0684 | 1047 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 1048 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 1049 | |
| ganlikun | 0:20e0c61e0684 | 1050 | /* Disable IT. Not always done before calling macro */ |
| ganlikun | 0:20e0c61e0684 | 1051 | __HAL_I2C_DISABLE_IT(handle, I2C_IT_ALL); |
| ganlikun | 0:20e0c61e0684 | 1052 | i2c_ev_err_disable(obj); |
| ganlikun | 0:20e0c61e0684 | 1053 | |
| ganlikun | 0:20e0c61e0684 | 1054 | /* Set event flag */ |
| ganlikun | 0:20e0c61e0684 | 1055 | obj_s->event = I2C_EVENT_ERROR; |
| ganlikun | 0:20e0c61e0684 | 1056 | } |
| ganlikun | 0:20e0c61e0684 | 1057 | |
| ganlikun | 0:20e0c61e0684 | 1058 | void i2c_transfer_asynch(i2c_t *obj, const void *tx, size_t tx_length, void *rx, size_t rx_length, uint32_t address, uint32_t stop, uint32_t handler, uint32_t event, DMAUsage hint) { |
| ganlikun | 0:20e0c61e0684 | 1059 | |
| ganlikun | 0:20e0c61e0684 | 1060 | // TODO: DMA usage is currently ignored by this way |
| ganlikun | 0:20e0c61e0684 | 1061 | (void) hint; |
| ganlikun | 0:20e0c61e0684 | 1062 | |
| ganlikun | 0:20e0c61e0684 | 1063 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 1064 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 1065 | |
| ganlikun | 0:20e0c61e0684 | 1066 | /* Update object */ |
| ganlikun | 0:20e0c61e0684 | 1067 | obj->tx_buff.buffer = (void *)tx; |
| ganlikun | 0:20e0c61e0684 | 1068 | obj->tx_buff.length = tx_length; |
| ganlikun | 0:20e0c61e0684 | 1069 | obj->tx_buff.pos = 0; |
| ganlikun | 0:20e0c61e0684 | 1070 | obj->tx_buff.width = 8; |
| ganlikun | 0:20e0c61e0684 | 1071 | |
| ganlikun | 0:20e0c61e0684 | 1072 | obj->rx_buff.buffer = (void *)rx; |
| ganlikun | 0:20e0c61e0684 | 1073 | obj->rx_buff.length = rx_length; |
| ganlikun | 0:20e0c61e0684 | 1074 | obj->rx_buff.pos = SIZE_MAX; |
| ganlikun | 0:20e0c61e0684 | 1075 | obj->rx_buff.width = 8; |
| ganlikun | 0:20e0c61e0684 | 1076 | |
| ganlikun | 0:20e0c61e0684 | 1077 | obj_s->available_events = event; |
| ganlikun | 0:20e0c61e0684 | 1078 | obj_s->event = 0; |
| ganlikun | 0:20e0c61e0684 | 1079 | obj_s->address = address; |
| ganlikun | 0:20e0c61e0684 | 1080 | obj_s->stop = stop; |
| ganlikun | 0:20e0c61e0684 | 1081 | |
| ganlikun | 0:20e0c61e0684 | 1082 | i2c_ev_err_enable(obj, handler); |
| ganlikun | 0:20e0c61e0684 | 1083 | |
| ganlikun | 0:20e0c61e0684 | 1084 | /* Set operation step depending if stop sending required or not */ |
| ganlikun | 0:20e0c61e0684 | 1085 | if ((tx_length && !rx_length) || (!tx_length && rx_length)) { |
| ganlikun | 0:20e0c61e0684 | 1086 | if ((obj_s->XferOperation == I2C_FIRST_AND_LAST_FRAME) || |
| ganlikun | 0:20e0c61e0684 | 1087 | (obj_s->XferOperation == I2C_LAST_FRAME)) { |
| ganlikun | 0:20e0c61e0684 | 1088 | if (stop) |
| ganlikun | 0:20e0c61e0684 | 1089 | obj_s->XferOperation = I2C_FIRST_AND_LAST_FRAME; |
| ganlikun | 0:20e0c61e0684 | 1090 | else |
| ganlikun | 0:20e0c61e0684 | 1091 | obj_s->XferOperation = I2C_FIRST_FRAME; |
| ganlikun | 0:20e0c61e0684 | 1092 | } else if ((obj_s->XferOperation == I2C_FIRST_FRAME) || |
| ganlikun | 0:20e0c61e0684 | 1093 | (obj_s->XferOperation == I2C_NEXT_FRAME)) { |
| ganlikun | 0:20e0c61e0684 | 1094 | if (stop) |
| ganlikun | 0:20e0c61e0684 | 1095 | obj_s->XferOperation = I2C_LAST_FRAME; |
| ganlikun | 0:20e0c61e0684 | 1096 | else |
| ganlikun | 0:20e0c61e0684 | 1097 | obj_s->XferOperation = I2C_NEXT_FRAME; |
| ganlikun | 0:20e0c61e0684 | 1098 | } |
| ganlikun | 0:20e0c61e0684 | 1099 | |
| ganlikun | 0:20e0c61e0684 | 1100 | if (tx_length > 0) { |
| ganlikun | 0:20e0c61e0684 | 1101 | HAL_I2C_Master_Sequential_Transmit_IT(handle, address, (uint8_t*)tx, tx_length, obj_s->XferOperation); |
| ganlikun | 0:20e0c61e0684 | 1102 | } |
| ganlikun | 0:20e0c61e0684 | 1103 | if (rx_length > 0) { |
| ganlikun | 0:20e0c61e0684 | 1104 | HAL_I2C_Master_Sequential_Receive_IT(handle, address, (uint8_t*)rx, rx_length, obj_s->XferOperation); |
| ganlikun | 0:20e0c61e0684 | 1105 | } |
| ganlikun | 0:20e0c61e0684 | 1106 | } |
| ganlikun | 0:20e0c61e0684 | 1107 | else if (tx_length && rx_length) { |
| ganlikun | 0:20e0c61e0684 | 1108 | /* Two steps operation, don't modify XferOperation, keep it for next step */ |
| ganlikun | 0:20e0c61e0684 | 1109 | if ((obj_s->XferOperation == I2C_FIRST_AND_LAST_FRAME) || |
| ganlikun | 0:20e0c61e0684 | 1110 | (obj_s->XferOperation == I2C_LAST_FRAME)) { |
| ganlikun | 0:20e0c61e0684 | 1111 | HAL_I2C_Master_Sequential_Transmit_IT(handle, address, (uint8_t*)tx, tx_length, I2C_FIRST_FRAME); |
| ganlikun | 0:20e0c61e0684 | 1112 | } else if ((obj_s->XferOperation == I2C_FIRST_FRAME) || |
| ganlikun | 0:20e0c61e0684 | 1113 | (obj_s->XferOperation == I2C_NEXT_FRAME)) { |
| ganlikun | 0:20e0c61e0684 | 1114 | HAL_I2C_Master_Sequential_Transmit_IT(handle, address, (uint8_t*)tx, tx_length, I2C_NEXT_FRAME); |
| ganlikun | 0:20e0c61e0684 | 1115 | } |
| ganlikun | 0:20e0c61e0684 | 1116 | } |
| ganlikun | 0:20e0c61e0684 | 1117 | } |
| ganlikun | 0:20e0c61e0684 | 1118 | |
| ganlikun | 0:20e0c61e0684 | 1119 | |
| ganlikun | 0:20e0c61e0684 | 1120 | uint32_t i2c_irq_handler_asynch(i2c_t *obj) { |
| ganlikun | 0:20e0c61e0684 | 1121 | |
| ganlikun | 0:20e0c61e0684 | 1122 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 1123 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 1124 | |
| ganlikun | 0:20e0c61e0684 | 1125 | HAL_I2C_EV_IRQHandler(handle); |
| ganlikun | 0:20e0c61e0684 | 1126 | HAL_I2C_ER_IRQHandler(handle); |
| ganlikun | 0:20e0c61e0684 | 1127 | |
| ganlikun | 0:20e0c61e0684 | 1128 | /* Return I2C event status */ |
| ganlikun | 0:20e0c61e0684 | 1129 | return (obj_s->event & obj_s->available_events); |
| ganlikun | 0:20e0c61e0684 | 1130 | } |
| ganlikun | 0:20e0c61e0684 | 1131 | |
| ganlikun | 0:20e0c61e0684 | 1132 | uint8_t i2c_active(i2c_t *obj) { |
| ganlikun | 0:20e0c61e0684 | 1133 | |
| ganlikun | 0:20e0c61e0684 | 1134 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 1135 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 1136 | |
| ganlikun | 0:20e0c61e0684 | 1137 | if (handle->State == HAL_I2C_STATE_READY) { |
| ganlikun | 0:20e0c61e0684 | 1138 | return 0; |
| ganlikun | 0:20e0c61e0684 | 1139 | } |
| ganlikun | 0:20e0c61e0684 | 1140 | else { |
| ganlikun | 0:20e0c61e0684 | 1141 | return 1; |
| ganlikun | 0:20e0c61e0684 | 1142 | } |
| ganlikun | 0:20e0c61e0684 | 1143 | } |
| ganlikun | 0:20e0c61e0684 | 1144 | |
| ganlikun | 0:20e0c61e0684 | 1145 | void i2c_abort_asynch(i2c_t *obj) { |
| ganlikun | 0:20e0c61e0684 | 1146 | |
| ganlikun | 0:20e0c61e0684 | 1147 | struct i2c_s *obj_s = I2C_S(obj); |
| ganlikun | 0:20e0c61e0684 | 1148 | I2C_HandleTypeDef *handle = &(obj_s->handle); |
| ganlikun | 0:20e0c61e0684 | 1149 | |
| ganlikun | 0:20e0c61e0684 | 1150 | /* Abort HAL requires DevAddress, but is not used. Use Dummy */ |
| ganlikun | 0:20e0c61e0684 | 1151 | uint16_t Dummy_DevAddress = 0x00; |
| ganlikun | 0:20e0c61e0684 | 1152 | |
| ganlikun | 0:20e0c61e0684 | 1153 | HAL_I2C_Master_Abort_IT(handle, Dummy_DevAddress); |
| ganlikun | 0:20e0c61e0684 | 1154 | } |
| ganlikun | 0:20e0c61e0684 | 1155 | |
| ganlikun | 0:20e0c61e0684 | 1156 | #endif // DEVICE_I2C_ASYNCH |
| ganlikun | 0:20e0c61e0684 | 1157 | |
| ganlikun | 0:20e0c61e0684 | 1158 | #endif // DEVICE_I2C |
| ganlikun | 0:20e0c61e0684 | 1159 |