diff --git a/.travis.yml b/.travis.yml index 99852c97..0337261e 100644 --- a/.travis.yml +++ b/.travis.yml @@ -33,7 +33,7 @@ install: - export TUP_DIR=$HOME/dl/tup_0.7.5-0~16.04.york0_amd64 - export TUP_ARCHIVE=$HOME/dl/tup_0.7.5-0~16.04.york0_amd64.deb -- export TUP_URL=http://ppa.launchpad.net/jonathonf/tup/ubuntu/pool/main/t/tup/tup_0.7.5-0~16.04.york0_amd64.deb +- export TUP_URL=http://ppa.launchpad.net/jonathonf/tup/ubuntu/pool/main/t/tup/tup_0.7.8-2~16.04.york0_amd64.deb - if [ ! -e $TUP_DIR/bin/tup ]; then wget $TUP_URL -O $TUP_ARCHIVE; dpkg-deb -R $TUP_ARCHIVE $TUP_DIR; fi - export PATH=$PATH:$TUP_DIR/usr/bin diff --git a/Arduino/ODriveArduino/ODriveArduino.cpp b/Arduino/ODriveArduino/ODriveArduino.cpp index 6e4a2748..2b2d6feb 100644 --- a/Arduino/ODriveArduino/ODriveArduino.cpp +++ b/Arduino/ODriveArduino/ODriveArduino.cpp @@ -38,6 +38,10 @@ void ODriveArduino::SetVelocity(int motor_number, float velocity, float current_ serial_ << "v " << motor_number << " " << velocity << " " << current_feedforward << "\n"; } +void ODriveArduino::SetCurrent(int motor_number, float current) { + serial_ << "c " << motor_number << " " << current << "\n"; +} + float ODriveArduino::readFloat() { return readString().toFloat(); } diff --git a/Arduino/ODriveArduino/ODriveArduino.h b/Arduino/ODriveArduino/ODriveArduino.h index 524f5a59..1ebe1e33 100644 --- a/Arduino/ODriveArduino/ODriveArduino.h +++ b/Arduino/ODriveArduino/ODriveArduino.h @@ -26,6 +26,7 @@ public: void SetPosition(int motor_number, float position, float velocity_feedforward, float current_feedforward); void SetVelocity(int motor_number, float velocity); void SetVelocity(int motor_number, float velocity, float current_feedforward); + void SetCurrent(int motor_number, float current); // General params float readFloat(); diff --git a/Arduino/ODriveArduino/examples/ODriveArduinoTest/ODriveArduinoTest.ino b/Arduino/ODriveArduino/examples/ODriveArduinoTest/ODriveArduinoTest.ino index f948f7f6..1e835026 100644 --- a/Arduino/ODriveArduino/examples/ODriveArduinoTest/ODriveArduinoTest.ino +++ b/Arduino/ODriveArduino/examples/ODriveArduinoTest/ODriveArduinoTest.ino @@ -8,6 +8,7 @@ template<> inline Print& operator <<(Print &obj, float arg) { obj.print(a // Serial to the ODrive SoftwareSerial odrive_serial(8, 9); //RX (ODrive TX), TX (ODrive RX) +// Note: you must also connect GND on ODrive to GND on Arduino! // ODrive object ODriveArduino odrive(odrive_serial); diff --git a/CHANGELOG.md b/CHANGELOG.md index 71edf5d8..46feb061 100644 --- a/CHANGELOG.md +++ b/CHANGELOG.md @@ -1,10 +1,32 @@ # Unreleased Features Please add a note of your changes below this heading if you make a Pull Request. -## Fixed -* Would ERROR_CONTROL_DEADLINE_MISSED along with every ERROR_PHASE_RESISTANCE_OUT_OF_RANGE. +### Added +* `dump_errors()` utility function in odrivetool to dump, decode and optionally clear errors. +* `q` command to ascii protocol. It is like the old `p` command, but velocity and current mean limits, not feed-forward. +* Voltage limit soft clamping instead of ERROR_MODULATION_MAGNITUDE in gimbal motor closed loop. +* Thermal current limit with linear derating. # Releases +## [0.4.7] - 2018-11-28 +### Added +* Overspeed fault +* Current sense saturation fault. +* Supress startup transients by sampling encoder estimate into position setpoint when entering closed loop control. +* Make step dir gpio pins configurable. +* Configuration variable `encoder.config.zero_count_on_find_idx`, true by default. Set to false to leave the initial encoder count to be where the axis was at boot. +* Circular position setpoint mode: position setpoints wrapped [0, cpr). Useful for infinite incremental position control. +* Velocity setpoint ramping. Use velocity control mode, and set `controller.vel_ramp_enable` to true. This will ramp `controller.vel_setpoint` towards `controller.vel_ramp_target` at a ramp rate of `controller.config.vel_ramp_rate`. + +### Changed +* Increased switching frequency from around 8kHz to 24kHz. Control loops still run at 8kHz. +* Renamed `axis.enable_step_dir` to `axis.step_dir_active` +* New process for working with STM32CubeMX. + +### Fixed +* Would get ERROR_CONTROL_DEADLINE_MISSED along with every ERROR_PHASE_RESISTANCE_OUT_OF_RANGE. +* ODrive tool can now run interactive nested scripts with "%run -i script.py" + ## [0.4.6] - 2018-10-07 ### Fixed * Broken printing of floats on ascii protocol diff --git a/Firmware/Board/v3/0001-display-correct-ODrive-version-in-USB-descriptor.patch b/Firmware/Board/v3/0001-display-correct-ODrive-version-in-USB-descriptor.patch deleted file mode 100644 index 0b031242..00000000 --- a/Firmware/Board/v3/0001-display-correct-ODrive-version-in-USB-descriptor.patch +++ /dev/null @@ -1,41 +0,0 @@ -From b7ea3f500fbfc187a0a7112282ae6b1eee4555d0 Mon Sep 17 00:00:00 2001 -From: Samuel Sadok -Date: Tue, 13 Mar 2018 20:05:07 -0700 -Subject: [PATCH] display correct ODrive version in USB descriptor - ---- - Firmware/Board/v3/Src/usbd_desc.c | 8 +++++--- - 1 file changed, 5 insertions(+), 3 deletions(-) - -diff --git a/Firmware/Board/v3/Src/usbd_desc.c b/Firmware/Board/v3/Src/usbd_desc.c -index 94dc49b..37b4302 100644 ---- a/Firmware/Board/v3/Src/usbd_desc.c -+++ b/Firmware/Board/v3/Src/usbd_desc.c -@@ -96,7 +96,9 @@ - #define USBD_LANGID_STRING 1033 - #define USBD_MANUFACTURER_STRING "ODrive Robotics" - #define USBD_PID_FS 0x0D32 --#define USBD_PRODUCT_STRING_FS "ODrive v3.3" -+#define USBD_PRODUCT_XSTR(s) USBD_PRODUCT_STR(s) -+#define USBD_PRODUCT_STR(s) #s -+#define USBD_PRODUCT_STRING_FS ODrive version HW_VERSION_MAJOR.HW_VERSION_MINOR - #define USBD_SERIALNUMBER_STRING_FS "000000000001" - #define USBD_CONFIGURATION_STRING_FS "CDC Config" - #define USBD_INTERFACE_STRING_FS "CDC Interface" -@@ -299,11 +301,11 @@ uint8_t * USBD_FS_ProductStrDescriptor(USBD_SpeedTypeDef speed, uint16_t *length - { - if(speed == 0) - { -- USBD_GetString((uint8_t *)USBD_PRODUCT_STRING_FS, USBD_StrDesc, length); -+ USBD_GetString((uint8_t *)USBD_PRODUCT_XSTR(USBD_PRODUCT_STRING_FS), USBD_StrDesc, length); - } - else - { -- USBD_GetString((uint8_t *)USBD_PRODUCT_STRING_FS, USBD_StrDesc, length); -+ USBD_GetString((uint8_t *)USBD_PRODUCT_XSTR(USBD_PRODUCT_STRING_FS), USBD_StrDesc, length); - } - return USBD_StrDesc; - } --- -2.16.2 - diff --git a/Firmware/Board/v3/0001-expose-correct-serial-number-on-USB.patch b/Firmware/Board/v3/0001-expose-correct-serial-number-on-USB.patch deleted file mode 100644 index b9fef648..00000000 --- a/Firmware/Board/v3/0001-expose-correct-serial-number-on-USB.patch +++ /dev/null @@ -1,32 +0,0 @@ -From 0867a92f742b312a0ebaafe94cade6f57be22170 Mon Sep 17 00:00:00 2001 -From: Samuel Sadok -Date: Mon, 12 Mar 2018 23:49:32 -0700 -Subject: [PATCH] expose correct serial number on USB - ---- - Firmware/Board/v3/Src/usbd_desc.c | 9 +++++++++------- - 1 file changed, 1 insertions(+), 8 deletions(-) - -diff --git a/Firmware/Board/v3/Src/usbd_desc.c b/Firmware/Board/v3/Src/usbd_desc.c -index b9c7bd0..94dc49b 100644 ---- a/Firmware/Board/v3/Src/usbd_desc.c -+++ b/Firmware/Board/v3/Src/usbd_desc.c -@@ -327,14 +327,7 @@ uint8_t * USBD_FS_ManufacturerStrDescriptor(USBD_SpeedTypeDef speed, uint16_t *l - */ - uint8_t * USBD_FS_SerialStrDescriptor(USBD_SpeedTypeDef speed, uint16_t *length) - { -- if(speed == USBD_SPEED_HIGH) -- { -- USBD_GetString((uint8_t *)USBD_SERIALNUMBER_STRING_FS, USBD_StrDesc, length); -- } -- else -- { -- USBD_GetString((uint8_t *)USBD_SERIALNUMBER_STRING_FS, USBD_StrDesc, length); -- } -+ USBD_GetString ((uint8_t *)serial_number_str, USBD_StrDesc, length); - return USBD_StrDesc; - } - --- -2.16.2 - diff --git a/Firmware/Board/v3/0001-fix-return-type-of-osSemaphoreWait.patch b/Firmware/Board/v3/0001-fix-return-type-of-osSemaphoreWait.patch deleted file mode 100644 index 53760fa1..00000000 --- a/Firmware/Board/v3/0001-fix-return-type-of-osSemaphoreWait.patch +++ /dev/null @@ -1,46 +0,0 @@ -From 49353ccb7023c02c2bc6e3b6f14fac02a13fe599 Mon Sep 17 00:00:00 2001 -From: Samuel Sadok -Date: Mon, 26 Feb 2018 14:55:17 -0800 -Subject: [PATCH] fix return type of osSemaphoreWait - ---- - .../Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.c | 6 +++--- - .../Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h | 6 +++--- - 2 files changed, 6 insertions(+), 6 deletions(-) - -diff --git a/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.c b/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.c -index d0e0fd7..e764cbc 100644 ---- a/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.c -+++ b/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.c -@@ -816,10 +816,10 @@ osSemaphoreId osSemaphoreCreate (const osSemaphoreDef_t *semaphore_def, int32_t - * @brief Wait until a Semaphore token becomes available - * @param semaphore_id semaphore object referenced with \ref osSemaphore. - * @param millisec timeout value or 0 in case of no time-out. --* @retval number of available tokens, or -1 in case of incorrect parameters. -+* @retval status code that indicates the execution status of the function. - * @note MUST REMAIN UNCHANGED: \b osSemaphoreWait shall be consistent in every CMSIS-RTOS. - */ --int32_t osSemaphoreWait (osSemaphoreId semaphore_id, uint32_t millisec) -+osStatus osSemaphoreWait (osSemaphoreId semaphore_id, uint32_t millisec) - { - TickType_t ticks; - portBASE_TYPE taskWoken = pdFALSE; -diff --git a/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h b/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h -index 15e25b9..5223f8e 100644 ---- a/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h -+++ b/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h -@@ -719,9 +719,9 @@ osSemaphoreId osSemaphoreCreate (const osSemaphoreDef_t *semaphore_def, int32_t - /// Wait until a Semaphore token becomes available. - /// \param[in] semaphore_id semaphore object referenced with \ref osSemaphoreCreate. - /// \param[in] millisec timeout value or 0 in case of no time-out. --/// \return number of available tokens, or -1 in case of incorrect parameters. -+/// \return status code that indicates the execution status of the function. - /// \note MUST REMAIN UNCHANGED: \b osSemaphoreWait shall be consistent in every CMSIS-RTOS. --int32_t osSemaphoreWait (osSemaphoreId semaphore_id, uint32_t millisec); -+osStatus osSemaphoreWait (osSemaphoreId semaphore_id, uint32_t millisec); - - /// Release a Semaphore token. - /// \param[in] semaphore_id semaphore object referenced with \ref osSemaphoreCreate. --- -2.16.1 - diff --git a/Firmware/Board/v3/0001-release-sem_usb_tx-in-usbd_cdc.c.patch b/Firmware/Board/v3/0001-release-sem_usb_tx-in-usbd_cdc.c.patch deleted file mode 100644 index b69370f5..00000000 --- a/Firmware/Board/v3/0001-release-sem_usb_tx-in-usbd_cdc.c.patch +++ /dev/null @@ -1,35 +0,0 @@ -From 965f7f2c80e30d7a66dcac7abaa9bdc371d9ea51 Mon Sep 17 00:00:00 2001 -From: Samuel Sadok -Date: Mon, 26 Feb 2018 14:53:52 -0800 -Subject: [PATCH] release sem_usb_tx in usbd_cdc.c - ---- - .../Middlewares/ST/STM32_USB_Device_Library/Class/CDC/Src/usbd_cdc.c | 5 +++-- - 1 file changed, 3 insertions(+), 2 deletions(-) - -diff --git a/Firmware/Board/v3/Middlewares/ST/STM32_USB_Device_Library/Class/CDC/Src/usbd_cdc.c b/Firmware/Board/v3.3/Middlewares/ST/STM32_USB_Device_Library/Class/CDC/Src/usbd_cdc.c -index b2ca5f1..6ae33e8 100644 ---- a/Firmware/Board/v3/Middlewares/ST/STM32_USB_Device_Library/Class/CDC/Src/usbd_cdc.c -+++ b/Firmware/Board/v3/Middlewares/ST/STM32_USB_Device_Library/Class/CDC/Src/usbd_cdc.c -@@ -62,7 +62,8 @@ - #include "usbd_cdc.h" - #include "usbd_desc.h" - #include "usbd_ctlreq.h" -- -+#include -+#include - - /** @addtogroup STM32_USB_DEVICE_LIBRARY - * @{ -@@ -669,7 +670,7 @@ static uint8_t USBD_CDC_DataIn (USBD_HandleTypeDef *pdev, uint8_t epnum) - { - - hcdc->TxState = 0; -- -+ osSemaphoreRelease(sem_usb_tx); - return USBD_OK; - } - else --- -2.16.1 - diff --git a/Firmware/Board/v3/0002-Add-I2C-files-and-settings.patch b/Firmware/Board/v3/0002-Add-I2C-files-and-settings.patch deleted file mode 100644 index aae18bf4..00000000 --- a/Firmware/Board/v3/0002-Add-I2C-files-and-settings.patch +++ /dev/null @@ -1,6860 +0,0 @@ -From b45bdbbbfe3d084d069da99b98116991923f5eb6 Mon Sep 17 00:00:00 2001 -From: Samuel Sadok -Date: Thu, 26 Apr 2018 13:20:38 -0700 -Subject: [PATCH] Add I2C files and settings - ---- - .../Inc/stm32f4xx_hal_i2c.h | 649 ++ - .../Inc/stm32f4xx_hal_i2c_ex.h | 137 + - .../Src/stm32f4xx_hal_i2c.c | 5494 +++++++++++++++++ - .../Src/stm32f4xx_hal_i2c_ex.c | 204 + - Firmware/Board/v3/Inc/i2c.h | 91 + - Firmware/Board/v3/Inc/stm32f4xx_hal_conf.h | 2 +- - Firmware/Board/v3/Odrive.ioc | 5 + - Firmware/Board/v3/Src/i2c.c | 198 + - Firmware/Board/v3/Src/main.c | 1 - - 11 files changed, 6811 insertions(+), 2 deletions(-) - create mode 100644 Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_i2c.h - create mode 100644 Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_i2c_ex.h - create mode 100644 Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal_i2c.c - create mode 100644 Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal_i2c_ex.c - create mode 100644 Firmware/Board/v3/Inc/i2c.h - create mode 100644 Firmware/Board/v3/Src/i2c.c - -diff --git a/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_i2c.h b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_i2c.h -new file mode 100644 -index 0000000..5452a50 ---- /dev/null -+++ b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_i2c.h -@@ -0,0 +1,649 @@ -+/** -+ ****************************************************************************** -+ * @file stm32f4xx_hal_i2c.h -+ * @author MCD Application Team -+ * @brief Header file of I2C HAL module. -+ ****************************************************************************** -+ * @attention -+ * -+ *

© COPYRIGHT(c) 2017 STMicroelectronics

-+ * -+ * Redistribution and use in source and binary forms, with or without modification, -+ * are permitted provided that the following conditions are met: -+ * 1. Redistributions of source code must retain the above copyright notice, -+ * this list of conditions and the following disclaimer. -+ * 2. Redistributions in binary form must reproduce the above copyright notice, -+ * this list of conditions and the following disclaimer in the documentation -+ * and/or other materials provided with the distribution. -+ * 3. Neither the name of STMicroelectronics nor the names of its contributors -+ * may be used to endorse or promote products derived from this software -+ * without specific prior written permission. -+ * -+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" -+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE -+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE -+ * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE -+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL -+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR -+ * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER -+ * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, -+ * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE -+ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. -+ * -+ ****************************************************************************** -+ */ -+ -+/* Define to prevent recursive inclusion -------------------------------------*/ -+#ifndef __STM32F4xx_HAL_I2C_H -+#define __STM32F4xx_HAL_I2C_H -+ -+#ifdef __cplusplus -+ extern "C" { -+#endif -+ -+/* Includes ------------------------------------------------------------------*/ -+#include "stm32f4xx_hal_def.h" -+ -+/** @addtogroup STM32F4xx_HAL_Driver -+ * @{ -+ */ -+ -+/** @addtogroup I2C -+ * @{ -+ */ -+ -+/* Exported types ------------------------------------------------------------*/ -+/** @defgroup I2C_Exported_Types I2C Exported Types -+ * @{ -+ */ -+ -+/** -+ * @brief I2C Configuration Structure definition -+ */ -+typedef struct -+{ -+ uint32_t ClockSpeed; /*!< Specifies the clock frequency. -+ This parameter must be set to a value lower than 400kHz */ -+ -+ uint32_t DutyCycle; /*!< Specifies the I2C fast mode duty cycle. -+ This parameter can be a value of @ref I2C_duty_cycle_in_fast_mode */ -+ -+ uint32_t OwnAddress1; /*!< Specifies the first device own address. -+ This parameter can be a 7-bit or 10-bit address. */ -+ -+ uint32_t AddressingMode; /*!< Specifies if 7-bit or 10-bit addressing mode is selected. -+ This parameter can be a value of @ref I2C_addressing_mode */ -+ -+ uint32_t DualAddressMode; /*!< Specifies if dual addressing mode is selected. -+ This parameter can be a value of @ref I2C_dual_addressing_mode */ -+ -+ uint32_t OwnAddress2; /*!< Specifies the second device own address if dual addressing mode is selected -+ This parameter can be a 7-bit address. */ -+ -+ uint32_t GeneralCallMode; /*!< Specifies if general call mode is selected. -+ This parameter can be a value of @ref I2C_general_call_addressing_mode */ -+ -+ uint32_t NoStretchMode; /*!< Specifies if nostretch mode is selected. -+ This parameter can be a value of @ref I2C_nostretch_mode */ -+ -+}I2C_InitTypeDef; -+ -+/** -+ * @brief HAL State structure definition -+ * @note HAL I2C State value coding follow below described bitmap : -+ * b7-b6 Error information -+ * 00 : No Error -+ * 01 : Abort (Abort user request on going) -+ * 10 : Timeout -+ * 11 : Error -+ * b5 IP initilisation status -+ * 0 : Reset (IP not initialized) -+ * 1 : Init done (IP initialized and ready to use. HAL I2C Init function called) -+ * b4 (not used) -+ * x : Should be set to 0 -+ * b3 -+ * 0 : Ready or Busy (No Listen mode ongoing) -+ * 1 : Listen (IP in Address Listen Mode) -+ * b2 Intrinsic process state -+ * 0 : Ready -+ * 1 : Busy (IP busy with some configuration or internal operations) -+ * b1 Rx state -+ * 0 : Ready (no Rx operation ongoing) -+ * 1 : Busy (Rx operation ongoing) -+ * b0 Tx state -+ * 0 : Ready (no Tx operation ongoing) -+ * 1 : Busy (Tx operation ongoing) -+ */ -+typedef enum -+{ -+ HAL_I2C_STATE_RESET = 0x00U, /*!< Peripheral is not yet Initialized */ -+ HAL_I2C_STATE_READY = 0x20U, /*!< Peripheral Initialized and ready for use */ -+ HAL_I2C_STATE_BUSY = 0x24U, /*!< An internal process is ongoing */ -+ HAL_I2C_STATE_BUSY_TX = 0x21U, /*!< Data Transmission process is ongoing */ -+ HAL_I2C_STATE_BUSY_RX = 0x22U, /*!< Data Reception process is ongoing */ -+ HAL_I2C_STATE_LISTEN = 0x28U, /*!< Address Listen Mode is ongoing */ -+ HAL_I2C_STATE_BUSY_TX_LISTEN = 0x29U, /*!< Address Listen Mode and Data Transmission -+ process is ongoing */ -+ HAL_I2C_STATE_BUSY_RX_LISTEN = 0x2AU, /*!< Address Listen Mode and Data Reception -+ process is ongoing */ -+ HAL_I2C_STATE_ABORT = 0x60U, /*!< Abort user request ongoing */ -+ HAL_I2C_STATE_TIMEOUT = 0xA0U, /*!< Timeout state */ -+ HAL_I2C_STATE_ERROR = 0xE0U /*!< Error */ -+ -+}HAL_I2C_StateTypeDef; -+ -+/** -+ * @brief HAL Mode structure definition -+ * @note HAL I2C Mode value coding follow below described bitmap : -+ * b7 (not used) -+ * x : Should be set to 0 -+ * b6 -+ * 0 : None -+ * 1 : Memory (HAL I2C communication is in Memory Mode) -+ * b5 -+ * 0 : None -+ * 1 : Slave (HAL I2C communication is in Slave Mode) -+ * b4 -+ * 0 : None -+ * 1 : Master (HAL I2C communication is in Master Mode) -+ * b3-b2-b1-b0 (not used) -+ * xxxx : Should be set to 0000 -+ */ -+typedef enum -+{ -+ HAL_I2C_MODE_NONE = 0x00U, /*!< No I2C communication on going */ -+ HAL_I2C_MODE_MASTER = 0x10U, /*!< I2C communication is in Master Mode */ -+ HAL_I2C_MODE_SLAVE = 0x20U, /*!< I2C communication is in Slave Mode */ -+ HAL_I2C_MODE_MEM = 0x40U /*!< I2C communication is in Memory Mode */ -+ -+}HAL_I2C_ModeTypeDef; -+ -+/** -+ * @brief I2C handle Structure definition -+ */ -+typedef struct -+{ -+ I2C_TypeDef *Instance; /*!< I2C registers base address */ -+ -+ I2C_InitTypeDef Init; /*!< I2C communication parameters */ -+ -+ uint8_t *pBuffPtr; /*!< Pointer to I2C transfer buffer */ -+ -+ uint16_t XferSize; /*!< I2C transfer size */ -+ -+ __IO uint16_t XferCount; /*!< I2C transfer counter */ -+ -+ __IO uint32_t XferOptions; /*!< I2C transfer options */ -+ -+ __IO uint32_t PreviousState; /*!< I2C communication Previous state and mode -+ context for internal usage */ -+ -+ DMA_HandleTypeDef *hdmatx; /*!< I2C Tx DMA handle parameters */ -+ -+ DMA_HandleTypeDef *hdmarx; /*!< I2C Rx DMA handle parameters */ -+ -+ HAL_LockTypeDef Lock; /*!< I2C locking object */ -+ -+ __IO HAL_I2C_StateTypeDef State; /*!< I2C communication state */ -+ -+ __IO HAL_I2C_ModeTypeDef Mode; /*!< I2C communication mode */ -+ -+ __IO uint32_t ErrorCode; /*!< I2C Error code */ -+ -+ __IO uint32_t Devaddress; /*!< I2C Target device address */ -+ -+ __IO uint32_t Memaddress; /*!< I2C Target memory address */ -+ -+ __IO uint32_t MemaddSize; /*!< I2C Target memory address size */ -+ -+ __IO uint32_t EventCount; /*!< I2C Event counter */ -+ -+}I2C_HandleTypeDef; -+ -+/** -+ * @} -+ */ -+ -+/* Exported constants --------------------------------------------------------*/ -+/** @defgroup I2C_Exported_Constants I2C Exported Constants -+ * @{ -+ */ -+ -+/** @defgroup I2C_Error_Code I2C Error Code -+ * @brief I2C Error Code -+ * @{ -+ */ -+#define HAL_I2C_ERROR_NONE 0x00000000U /*!< No error */ -+#define HAL_I2C_ERROR_BERR 0x00000001U /*!< BERR error */ -+#define HAL_I2C_ERROR_ARLO 0x00000002U /*!< ARLO error */ -+#define HAL_I2C_ERROR_AF 0x00000004U /*!< AF error */ -+#define HAL_I2C_ERROR_OVR 0x00000008U /*!< OVR error */ -+#define HAL_I2C_ERROR_DMA 0x00000010U /*!< DMA transfer error */ -+#define HAL_I2C_ERROR_TIMEOUT 0x00000020U /*!< Timeout Error */ -+/** -+ * @} -+ */ -+ -+/** @defgroup I2C_duty_cycle_in_fast_mode I2C duty cycle in fast mode -+ * @{ -+ */ -+#define I2C_DUTYCYCLE_2 0x00000000U -+#define I2C_DUTYCYCLE_16_9 I2C_CCR_DUTY -+/** -+ * @} -+ */ -+ -+/** @defgroup I2C_addressing_mode I2C addressing mode -+ * @{ -+ */ -+#define I2C_ADDRESSINGMODE_7BIT 0x00004000U -+#define I2C_ADDRESSINGMODE_10BIT (I2C_OAR1_ADDMODE | 0x00004000U) -+/** -+ * @} -+ */ -+ -+/** @defgroup I2C_dual_addressing_mode I2C dual addressing mode -+ * @{ -+ */ -+#define I2C_DUALADDRESS_DISABLE 0x00000000U -+#define I2C_DUALADDRESS_ENABLE I2C_OAR2_ENDUAL -+/** -+ * @} -+ */ -+ -+/** @defgroup I2C_general_call_addressing_mode I2C general call addressing mode -+ * @{ -+ */ -+#define I2C_GENERALCALL_DISABLE 0x00000000U -+#define I2C_GENERALCALL_ENABLE I2C_CR1_ENGC -+/** -+ * @} -+ */ -+ -+/** @defgroup I2C_nostretch_mode I2C nostretch mode -+ * @{ -+ */ -+#define I2C_NOSTRETCH_DISABLE 0x00000000U -+#define I2C_NOSTRETCH_ENABLE I2C_CR1_NOSTRETCH -+/** -+ * @} -+ */ -+ -+/** @defgroup I2C_Memory_Address_Size I2C Memory Address Size -+ * @{ -+ */ -+#define I2C_MEMADD_SIZE_8BIT 0x00000001U -+#define I2C_MEMADD_SIZE_16BIT 0x00000010U -+/** -+ * @} -+ */ -+ -+/** @defgroup I2C_XferDirection_definition I2C XferDirection definition -+ * @{ -+ */ -+#define I2C_DIRECTION_RECEIVE 0x00000000U -+#define I2C_DIRECTION_TRANSMIT 0x00000001U -+/** -+ * @} -+ */ -+ -+/** @defgroup I2C_XferOptions_definition I2C XferOptions definition -+ * @{ -+ */ -+#define I2C_FIRST_FRAME 0x00000001U -+#define I2C_NEXT_FRAME 0x00000002U -+#define I2C_FIRST_AND_LAST_FRAME 0x00000004U -+#define I2C_LAST_FRAME 0x00000008U -+/** -+ * @} -+ */ -+ -+/** @defgroup I2C_Interrupt_configuration_definition I2C Interrupt configuration definition -+ * @{ -+ */ -+#define I2C_IT_BUF I2C_CR2_ITBUFEN -+#define I2C_IT_EVT I2C_CR2_ITEVTEN -+#define I2C_IT_ERR I2C_CR2_ITERREN -+/** -+ * @} -+ */ -+ -+/** @defgroup I2C_Flag_definition I2C Flag definition -+ * @{ -+ */ -+#define I2C_FLAG_SMBALERT 0x00018000U -+#define I2C_FLAG_TIMEOUT 0x00014000U -+#define I2C_FLAG_PECERR 0x00011000U -+#define I2C_FLAG_OVR 0x00010800U -+#define I2C_FLAG_AF 0x00010400U -+#define I2C_FLAG_ARLO 0x00010200U -+#define I2C_FLAG_BERR 0x00010100U -+#define I2C_FLAG_TXE 0x00010080U -+#define I2C_FLAG_RXNE 0x00010040U -+#define I2C_FLAG_STOPF 0x00010010U -+#define I2C_FLAG_ADD10 0x00010008U -+#define I2C_FLAG_BTF 0x00010004U -+#define I2C_FLAG_ADDR 0x00010002U -+#define I2C_FLAG_SB 0x00010001U -+#define I2C_FLAG_DUALF 0x00100080U -+#define I2C_FLAG_SMBHOST 0x00100040U -+#define I2C_FLAG_SMBDEFAULT 0x00100020U -+#define I2C_FLAG_GENCALL 0x00100010U -+#define I2C_FLAG_TRA 0x00100004U -+#define I2C_FLAG_BUSY 0x00100002U -+#define I2C_FLAG_MSL 0x00100001U -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+ -+/* Exported macro ------------------------------------------------------------*/ -+/** @defgroup I2C_Exported_Macros I2C Exported Macros -+ * @{ -+ */ -+ -+/** @brief Reset I2C handle state -+ * @param __HANDLE__ specifies the I2C Handle. -+ * This parameter can be I2C where x: 1, 2, or 3 to select the I2C peripheral. -+ * @retval None -+ */ -+#define __HAL_I2C_RESET_HANDLE_STATE(__HANDLE__) ((__HANDLE__)->State = HAL_I2C_STATE_RESET) -+ -+/** @brief Enable or disable the specified I2C interrupts. -+ * @param __HANDLE__ specifies the I2C Handle. -+ * This parameter can be I2C where x: 1, 2, or 3 to select the I2C peripheral. -+ * @param __INTERRUPT__ specifies the interrupt source to enable or disable. -+ * This parameter can be one of the following values: -+ * @arg I2C_IT_BUF: Buffer interrupt enable -+ * @arg I2C_IT_EVT: Event interrupt enable -+ * @arg I2C_IT_ERR: Error interrupt enable -+ * @retval None -+ */ -+#define __HAL_I2C_ENABLE_IT(__HANDLE__, __INTERRUPT__) ((__HANDLE__)->Instance->CR2 |= (__INTERRUPT__)) -+#define __HAL_I2C_DISABLE_IT(__HANDLE__, __INTERRUPT__) ((__HANDLE__)->Instance->CR2 &= (~(__INTERRUPT__))) -+ -+/** @brief Checks if the specified I2C interrupt source is enabled or disabled. -+ * @param __HANDLE__ specifies the I2C Handle. -+ * This parameter can be I2C where x: 1, 2, or 3 to select the I2C peripheral. -+ * @param __INTERRUPT__ specifies the I2C interrupt source to check. -+ * This parameter can be one of the following values: -+ * @arg I2C_IT_BUF: Buffer interrupt enable -+ * @arg I2C_IT_EVT: Event interrupt enable -+ * @arg I2C_IT_ERR: Error interrupt enable -+ * @retval The new state of __INTERRUPT__ (TRUE or FALSE). -+ */ -+#define __HAL_I2C_GET_IT_SOURCE(__HANDLE__, __INTERRUPT__) ((((__HANDLE__)->Instance->CR2 & (__INTERRUPT__)) == (__INTERRUPT__)) ? SET : RESET) -+ -+/** @brief Checks whether the specified I2C flag is set or not. -+ * @param __HANDLE__ specifies the I2C Handle. -+ * This parameter can be I2C where x: 1, 2, or 3 to select the I2C peripheral. -+ * @param __FLAG__ specifies the flag to check. -+ * This parameter can be one of the following values: -+ * @arg I2C_FLAG_SMBALERT: SMBus Alert flag -+ * @arg I2C_FLAG_TIMEOUT: Timeout or Tlow error flag -+ * @arg I2C_FLAG_PECERR: PEC error in reception flag -+ * @arg I2C_FLAG_OVR: Overrun/Underrun flag -+ * @arg I2C_FLAG_AF: Acknowledge failure flag -+ * @arg I2C_FLAG_ARLO: Arbitration lost flag -+ * @arg I2C_FLAG_BERR: Bus error flag -+ * @arg I2C_FLAG_TXE: Data register empty flag -+ * @arg I2C_FLAG_RXNE: Data register not empty flag -+ * @arg I2C_FLAG_STOPF: Stop detection flag -+ * @arg I2C_FLAG_ADD10: 10-bit header sent flag -+ * @arg I2C_FLAG_BTF: Byte transfer finished flag -+ * @arg I2C_FLAG_ADDR: Address sent flag -+ * Address matched flag -+ * @arg I2C_FLAG_SB: Start bit flag -+ * @arg I2C_FLAG_DUALF: Dual flag -+ * @arg I2C_FLAG_SMBHOST: SMBus host header -+ * @arg I2C_FLAG_SMBDEFAULT: SMBus default header -+ * @arg I2C_FLAG_GENCALL: General call header flag -+ * @arg I2C_FLAG_TRA: Transmitter/Receiver flag -+ * @arg I2C_FLAG_BUSY: Bus busy flag -+ * @arg I2C_FLAG_MSL: Master/Slave flag -+ * @retval The new state of __FLAG__ (TRUE or FALSE). -+ */ -+#define __HAL_I2C_GET_FLAG(__HANDLE__, __FLAG__) ((((uint8_t)((__FLAG__) >> 16U)) == 0x01U)?((((__HANDLE__)->Instance->SR1) & ((__FLAG__) & I2C_FLAG_MASK)) == ((__FLAG__) & I2C_FLAG_MASK)): \ -+ ((((__HANDLE__)->Instance->SR2) & ((__FLAG__) & I2C_FLAG_MASK)) == ((__FLAG__) & I2C_FLAG_MASK))) -+ -+/** @brief Clears the I2C pending flags which are cleared by writing 0 in a specific bit. -+ * @param __HANDLE__ specifies the I2C Handle. -+ * This parameter can be I2C where x: 1, 2, or 3 to select the I2C peripheral. -+ * @param __FLAG__ specifies the flag to clear. -+ * This parameter can be any combination of the following values: -+ * @arg I2C_FLAG_SMBALERT: SMBus Alert flag -+ * @arg I2C_FLAG_TIMEOUT: Timeout or Tlow error flag -+ * @arg I2C_FLAG_PECERR: PEC error in reception flag -+ * @arg I2C_FLAG_OVR: Overrun/Underrun flag (Slave mode) -+ * @arg I2C_FLAG_AF: Acknowledge failure flag -+ * @arg I2C_FLAG_ARLO: Arbitration lost flag (Master mode) -+ * @arg I2C_FLAG_BERR: Bus error flag -+ * @retval None -+ */ -+#define __HAL_I2C_CLEAR_FLAG(__HANDLE__, __FLAG__) ((__HANDLE__)->Instance->SR1 = ~((__FLAG__) & I2C_FLAG_MASK)) -+ -+/** @brief Clears the I2C ADDR pending flag. -+ * @param __HANDLE__ specifies the I2C Handle. -+ * This parameter can be I2C where x: 1, 2, or 3 to select the I2C peripheral. -+ * @retval None -+ */ -+#define __HAL_I2C_CLEAR_ADDRFLAG(__HANDLE__) \ -+ do{ \ -+ __IO uint32_t tmpreg = 0x00U; \ -+ tmpreg = (__HANDLE__)->Instance->SR1; \ -+ tmpreg = (__HANDLE__)->Instance->SR2; \ -+ UNUSED(tmpreg); \ -+ } while(0) -+ -+/** @brief Clears the I2C STOPF pending flag. -+ * @param __HANDLE__ specifies the I2C Handle. -+ * This parameter can be I2C where x: 1, 2, or 3 to select the I2C peripheral. -+ * @retval None -+ */ -+#define __HAL_I2C_CLEAR_STOPFLAG(__HANDLE__) \ -+ do{ \ -+ __IO uint32_t tmpreg = 0x00U; \ -+ tmpreg = (__HANDLE__)->Instance->SR1; \ -+ (__HANDLE__)->Instance->CR1 |= I2C_CR1_PE; \ -+ UNUSED(tmpreg); \ -+ } while(0) -+ -+/** @brief Enable the I2C peripheral. -+ * @param __HANDLE__ specifies the I2C Handle. -+ * This parameter can be I2Cx where x: 1 or 2 to select the I2C peripheral. -+ * @retval None -+ */ -+#define __HAL_I2C_ENABLE(__HANDLE__) ((__HANDLE__)->Instance->CR1 |= I2C_CR1_PE) -+ -+/** @brief Disable the I2C peripheral. -+ * @param __HANDLE__ specifies the I2C Handle. -+ * This parameter can be I2Cx where x: 1 or 2 to select the I2C peripheral. -+ * @retval None -+ */ -+#define __HAL_I2C_DISABLE(__HANDLE__) ((__HANDLE__)->Instance->CR1 &= ~I2C_CR1_PE) -+ -+/** -+ * @} -+ */ -+ -+/* Include I2C HAL Extension module */ -+#include "stm32f4xx_hal_i2c_ex.h" -+ -+/* Exported functions --------------------------------------------------------*/ -+/** @addtogroup I2C_Exported_Functions -+ * @{ -+ */ -+ -+/** @addtogroup I2C_Exported_Functions_Group1 -+ * @{ -+ */ -+/* Initialization/de-initialization functions **********************************/ -+HAL_StatusTypeDef HAL_I2C_Init(I2C_HandleTypeDef *hi2c); -+HAL_StatusTypeDef HAL_I2C_DeInit (I2C_HandleTypeDef *hi2c); -+void HAL_I2C_MspInit(I2C_HandleTypeDef *hi2c); -+void HAL_I2C_MspDeInit(I2C_HandleTypeDef *hi2c); -+/** -+ * @} -+ */ -+ -+/** @addtogroup I2C_Exported_Functions_Group2 -+ * @{ -+ */ -+/* I/O operation functions *****************************************************/ -+/******* Blocking mode: Polling */ -+HAL_StatusTypeDef HAL_I2C_Master_Transmit(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size, uint32_t Timeout); -+HAL_StatusTypeDef HAL_I2C_Master_Receive(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size, uint32_t Timeout); -+HAL_StatusTypeDef HAL_I2C_Slave_Transmit(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size, uint32_t Timeout); -+HAL_StatusTypeDef HAL_I2C_Slave_Receive(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size, uint32_t Timeout); -+HAL_StatusTypeDef HAL_I2C_Mem_Write(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint8_t *pData, uint16_t Size, uint32_t Timeout); -+HAL_StatusTypeDef HAL_I2C_Mem_Read(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint8_t *pData, uint16_t Size, uint32_t Timeout); -+HAL_StatusTypeDef HAL_I2C_IsDeviceReady(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint32_t Trials, uint32_t Timeout); -+ -+/******* Non-Blocking mode: Interrupt */ -+HAL_StatusTypeDef HAL_I2C_Master_Transmit_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size); -+HAL_StatusTypeDef HAL_I2C_Master_Receive_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size); -+HAL_StatusTypeDef HAL_I2C_Slave_Transmit_IT(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size); -+HAL_StatusTypeDef HAL_I2C_Slave_Receive_IT(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size); -+HAL_StatusTypeDef HAL_I2C_Mem_Write_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint8_t *pData, uint16_t Size); -+HAL_StatusTypeDef HAL_I2C_Mem_Read_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint8_t *pData, uint16_t Size); -+ -+HAL_StatusTypeDef HAL_I2C_Master_Sequential_Transmit_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size, uint32_t XferOptions); -+HAL_StatusTypeDef HAL_I2C_Master_Sequential_Receive_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size, uint32_t XferOptions); -+HAL_StatusTypeDef HAL_I2C_Slave_Sequential_Transmit_IT(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size, uint32_t XferOptions); -+HAL_StatusTypeDef HAL_I2C_Slave_Sequential_Receive_IT(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size, uint32_t XferOptions); -+HAL_StatusTypeDef HAL_I2C_Master_Abort_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress); -+HAL_StatusTypeDef HAL_I2C_EnableListen_IT(I2C_HandleTypeDef *hi2c); -+HAL_StatusTypeDef HAL_I2C_DisableListen_IT(I2C_HandleTypeDef *hi2c); -+ -+/******* Non-Blocking mode: DMA */ -+HAL_StatusTypeDef HAL_I2C_Master_Transmit_DMA(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size); -+HAL_StatusTypeDef HAL_I2C_Master_Receive_DMA(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size); -+HAL_StatusTypeDef HAL_I2C_Slave_Transmit_DMA(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size); -+HAL_StatusTypeDef HAL_I2C_Slave_Receive_DMA(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size); -+HAL_StatusTypeDef HAL_I2C_Mem_Write_DMA(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint8_t *pData, uint16_t Size); -+HAL_StatusTypeDef HAL_I2C_Mem_Read_DMA(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint8_t *pData, uint16_t Size); -+ -+/******* I2C IRQHandler and Callbacks used in non blocking modes (Interrupt and DMA) */ -+void HAL_I2C_EV_IRQHandler(I2C_HandleTypeDef *hi2c); -+void HAL_I2C_ER_IRQHandler(I2C_HandleTypeDef *hi2c); -+void HAL_I2C_MasterTxCpltCallback(I2C_HandleTypeDef *hi2c); -+void HAL_I2C_MasterRxCpltCallback(I2C_HandleTypeDef *hi2c); -+void HAL_I2C_SlaveTxCpltCallback(I2C_HandleTypeDef *hi2c); -+void HAL_I2C_SlaveRxCpltCallback(I2C_HandleTypeDef *hi2c); -+void HAL_I2C_AddrCallback(I2C_HandleTypeDef *hi2c, uint8_t TransferDirection, uint16_t AddrMatchCode); -+void HAL_I2C_ListenCpltCallback(I2C_HandleTypeDef *hi2c); -+void HAL_I2C_MemTxCpltCallback(I2C_HandleTypeDef *hi2c); -+void HAL_I2C_MemRxCpltCallback(I2C_HandleTypeDef *hi2c); -+void HAL_I2C_ErrorCallback(I2C_HandleTypeDef *hi2c); -+void HAL_I2C_AbortCpltCallback(I2C_HandleTypeDef *hi2c); -+/** -+ * @} -+ */ -+ -+/** @addtogroup I2C_Exported_Functions_Group3 -+ * @{ -+ */ -+/* Peripheral State, Mode and Errors functions *********************************/ -+HAL_I2C_StateTypeDef HAL_I2C_GetState(I2C_HandleTypeDef *hi2c); -+HAL_I2C_ModeTypeDef HAL_I2C_GetMode(I2C_HandleTypeDef *hi2c); -+uint32_t HAL_I2C_GetError(I2C_HandleTypeDef *hi2c); -+ -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+/* Private types -------------------------------------------------------------*/ -+/* Private variables ---------------------------------------------------------*/ -+/* Private constants ---------------------------------------------------------*/ -+/** @defgroup I2C_Private_Constants I2C Private Constants -+ * @{ -+ */ -+#define I2C_FLAG_MASK 0x0000FFFFU -+/** -+ * @} -+ */ -+ -+/* Private macros ------------------------------------------------------------*/ -+/** @defgroup I2C_Private_Macros I2C Private Macros -+ * @{ -+ */ -+ -+#define I2C_FREQRANGE(__PCLK__) ((__PCLK__)/1000000U) -+#define I2C_RISE_TIME(__FREQRANGE__, __SPEED__) (((__SPEED__) <= 100000U) ? ((__FREQRANGE__) + 1U) : ((((__FREQRANGE__) * 300U) / 1000U) + 1U)) -+#define I2C_SPEED_STANDARD(__PCLK__, __SPEED__) (((((__PCLK__)/((__SPEED__) << 1U)) & I2C_CCR_CCR) < 4U)? 4U:((__PCLK__) / ((__SPEED__) << 1U))) -+#define I2C_SPEED_FAST(__PCLK__, __SPEED__, __DUTYCYCLE__) (((__DUTYCYCLE__) == I2C_DUTYCYCLE_2)? ((__PCLK__) / ((__SPEED__) * 3U)) : (((__PCLK__) / ((__SPEED__) * 25U)) | I2C_DUTYCYCLE_16_9)) -+#define I2C_SPEED(__PCLK__, __SPEED__, __DUTYCYCLE__) (((__SPEED__) <= 100000U)? (I2C_SPEED_STANDARD((__PCLK__), (__SPEED__))) : \ -+ ((I2C_SPEED_FAST((__PCLK__), (__SPEED__), (__DUTYCYCLE__)) & I2C_CCR_CCR) == 0U)? 1U : \ -+ ((I2C_SPEED_FAST((__PCLK__), (__SPEED__), (__DUTYCYCLE__))) | I2C_CCR_FS)) -+ -+#define I2C_7BIT_ADD_WRITE(__ADDRESS__) ((uint8_t)((__ADDRESS__) & (~I2C_OAR1_ADD0))) -+#define I2C_7BIT_ADD_READ(__ADDRESS__) ((uint8_t)((__ADDRESS__) | I2C_OAR1_ADD0)) -+ -+#define I2C_10BIT_ADDRESS(__ADDRESS__) ((uint8_t)((uint16_t)((__ADDRESS__) & (uint16_t)0x00FF))) -+#define I2C_10BIT_HEADER_WRITE(__ADDRESS__) ((uint8_t)((uint16_t)((uint16_t)(((uint16_t)((__ADDRESS__) & (uint16_t)0x0300)) >> 7) | (uint16_t)0x00F0))) -+#define I2C_10BIT_HEADER_READ(__ADDRESS__) ((uint8_t)((uint16_t)((uint16_t)(((uint16_t)((__ADDRESS__) & (uint16_t)0x0300)) >> 7) | (uint16_t)(0x00F1)))) -+ -+#define I2C_MEM_ADD_MSB(__ADDRESS__) ((uint8_t)((uint16_t)(((uint16_t)((__ADDRESS__) & (uint16_t)0xFF00)) >> 8))) -+#define I2C_MEM_ADD_LSB(__ADDRESS__) ((uint8_t)((uint16_t)((__ADDRESS__) & (uint16_t)0x00FF))) -+ -+/** @defgroup I2C_IS_RTC_Definitions I2C Private macros to check input parameters -+ * @{ -+ */ -+#define IS_I2C_DUTY_CYCLE(CYCLE) (((CYCLE) == I2C_DUTYCYCLE_2) || \ -+ ((CYCLE) == I2C_DUTYCYCLE_16_9)) -+#define IS_I2C_ADDRESSING_MODE(ADDRESS) (((ADDRESS) == I2C_ADDRESSINGMODE_7BIT) || \ -+ ((ADDRESS) == I2C_ADDRESSINGMODE_10BIT)) -+#define IS_I2C_DUAL_ADDRESS(ADDRESS) (((ADDRESS) == I2C_DUALADDRESS_DISABLE) || \ -+ ((ADDRESS) == I2C_DUALADDRESS_ENABLE)) -+#define IS_I2C_GENERAL_CALL(CALL) (((CALL) == I2C_GENERALCALL_DISABLE) || \ -+ ((CALL) == I2C_GENERALCALL_ENABLE)) -+#define IS_I2C_NO_STRETCH(STRETCH) (((STRETCH) == I2C_NOSTRETCH_DISABLE) || \ -+ ((STRETCH) == I2C_NOSTRETCH_ENABLE)) -+#define IS_I2C_MEMADD_SIZE(SIZE) (((SIZE) == I2C_MEMADD_SIZE_8BIT) || \ -+ ((SIZE) == I2C_MEMADD_SIZE_16BIT)) -+#define IS_I2C_CLOCK_SPEED(SPEED) (((SPEED) > 0U) && ((SPEED) <= 400000U)) -+#define IS_I2C_OWN_ADDRESS1(ADDRESS1) (((ADDRESS1) & 0xFFFFFC00U) == 0U) -+#define IS_I2C_OWN_ADDRESS2(ADDRESS2) (((ADDRESS2) & 0xFFFFFF01U) == 0U) -+#define IS_I2C_TRANSFER_OPTIONS_REQUEST(REQUEST) (((REQUEST) == I2C_FIRST_FRAME) || \ -+ ((REQUEST) == I2C_NEXT_FRAME) || \ -+ ((REQUEST) == I2C_FIRST_AND_LAST_FRAME) || \ -+ ((REQUEST) == I2C_LAST_FRAME)) -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+ -+/* Private functions ---------------------------------------------------------*/ -+/** @defgroup I2C_Private_Functions I2C Private Functions -+ * @{ -+ */ -+ -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+ -+#ifdef __cplusplus -+} -+#endif -+ -+ -+#endif /* __STM32F4xx_HAL_I2C_H */ -+ -+/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/ -diff --git a/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_i2c_ex.h b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_i2c_ex.h -new file mode 100644 -index 0000000..ff47d5c ---- /dev/null -+++ b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_i2c_ex.h -@@ -0,0 +1,137 @@ -+/** -+ ****************************************************************************** -+ * @file stm32f4xx_hal_i2c_ex.h -+ * @author MCD Application Team -+ * @brief Header file of I2C HAL Extension module. -+ ****************************************************************************** -+ * @attention -+ * -+ *

© COPYRIGHT(c) 2017 STMicroelectronics

-+ * -+ * Redistribution and use in source and binary forms, with or without modification, -+ * are permitted provided that the following conditions are met: -+ * 1. Redistributions of source code must retain the above copyright notice, -+ * this list of conditions and the following disclaimer. -+ * 2. Redistributions in binary form must reproduce the above copyright notice, -+ * this list of conditions and the following disclaimer in the documentation -+ * and/or other materials provided with the distribution. -+ * 3. Neither the name of STMicroelectronics nor the names of its contributors -+ * may be used to endorse or promote products derived from this software -+ * without specific prior written permission. -+ * -+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" -+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE -+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE -+ * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE -+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL -+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR -+ * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER -+ * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, -+ * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE -+ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. -+ * -+ ****************************************************************************** -+ */ -+ -+/* Define to prevent recursive inclusion -------------------------------------*/ -+#ifndef __STM32F4xx_HAL_I2C_EX_H -+#define __STM32F4xx_HAL_I2C_EX_H -+ -+#ifdef __cplusplus -+ extern "C" { -+#endif -+ -+#if defined(STM32F427xx) || defined(STM32F437xx) || defined(STM32F429xx) || defined(STM32F439xx) ||\ -+ defined(STM32F401xC) || defined(STM32F401xE) || defined(STM32F411xE) || defined(STM32F446xx) ||\ -+ defined(STM32F469xx) || defined(STM32F479xx) || defined(STM32F413xx) || defined(STM32F423xx) -+/* Includes ------------------------------------------------------------------*/ -+#include "stm32f4xx_hal_def.h" -+ -+/** @addtogroup STM32F4xx_HAL_Driver -+ * @{ -+ */ -+ -+/** @addtogroup I2CEx -+ * @{ -+ */ -+ -+/* Exported types ------------------------------------------------------------*/ -+/* Exported constants --------------------------------------------------------*/ -+/** @defgroup I2CEx_Exported_Constants I2C Exported Constants -+ * @{ -+ */ -+ -+/** @defgroup I2CEx_Analog_Filter I2C Analog Filter -+ * @{ -+ */ -+#define I2C_ANALOGFILTER_ENABLE 0x00000000U -+#define I2C_ANALOGFILTER_DISABLE I2C_FLTR_ANOFF -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+ -+/* Exported macro ------------------------------------------------------------*/ -+/* Exported functions --------------------------------------------------------*/ -+/** @addtogroup I2CEx_Exported_Functions -+ * @{ -+ */ -+ -+/** @addtogroup I2CEx_Exported_Functions_Group1 -+ * @{ -+ */ -+/* Peripheral Control functions ************************************************/ -+HAL_StatusTypeDef HAL_I2CEx_ConfigAnalogFilter(I2C_HandleTypeDef *hi2c, uint32_t AnalogFilter); -+HAL_StatusTypeDef HAL_I2CEx_ConfigDigitalFilter(I2C_HandleTypeDef *hi2c, uint32_t DigitalFilter); -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+/* Private types -------------------------------------------------------------*/ -+/* Private variables ---------------------------------------------------------*/ -+/* Private constants ---------------------------------------------------------*/ -+/** @defgroup I2CEx_Private_Constants I2C Private Constants -+ * @{ -+ */ -+ -+/** -+ * @} -+ */ -+ -+/* Private macros ------------------------------------------------------------*/ -+/** @defgroup I2CEx_Private_Macros I2C Private Macros -+ * @{ -+ */ -+#define IS_I2C_ANALOG_FILTER(FILTER) (((FILTER) == I2C_ANALOGFILTER_ENABLE) || \ -+ ((FILTER) == I2C_ANALOGFILTER_DISABLE)) -+#define IS_I2C_DIGITAL_FILTER(FILTER) ((FILTER) <= 0x0000000FU) -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+ -+#endif /* STM32F427xx || STM32F429xx || STM32F437xx || STM32F439xx || STM32F401xC ||\ -+ STM32F401xE || STM32F411xE || STM32F446xx || STM32F469xx || STM32F479xx ||\ -+ STM32F413xx || STM32F423xx */ -+ -+#ifdef __cplusplus -+} -+#endif -+ -+#endif /* __STM32F4xx_HAL_I2C_EX_H */ -+ -+ -+/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/ -diff --git a/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal_i2c.c b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal_i2c.c -new file mode 100644 -index 0000000..da18520 ---- /dev/null -+++ b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal_i2c.c -@@ -0,0 +1,5494 @@ -+/** -+ ****************************************************************************** -+ * @file stm32f4xx_hal_i2c.c -+ * @author MCD Application Team -+ * @brief I2C HAL module driver. -+ * This file provides firmware functions to manage the following -+ * functionalities of the Inter Integrated Circuit (I2C) peripheral: -+ * + Initialization and de-initialization functions -+ * + IO operation functions -+ * + Peripheral State, Mode and Error functions -+ * -+ @verbatim -+ ============================================================================== -+ ##### How to use this driver ##### -+ ============================================================================== -+ [..] -+ The I2C HAL driver can be used as follows: -+ -+ (#) Declare a I2C_HandleTypeDef handle structure, for example: -+ I2C_HandleTypeDef hi2c; -+ -+ (#)Initialize the I2C low level resources by implementing the HAL_I2C_MspInit() API: -+ (##) Enable the I2Cx interface clock -+ (##) I2C pins configuration -+ (+++) Enable the clock for the I2C GPIOs -+ (+++) Configure I2C pins as alternate function open-drain -+ (##) NVIC configuration if you need to use interrupt process -+ (+++) Configure the I2Cx interrupt priority -+ (+++) Enable the NVIC I2C IRQ Channel -+ (##) DMA Configuration if you need to use DMA process -+ (+++) Declare a DMA_HandleTypeDef handle structure for the transmit or receive stream -+ (+++) Enable the DMAx interface clock using -+ (+++) Configure the DMA handle parameters -+ (+++) Configure the DMA Tx or Rx Stream -+ (+++) Associate the initialized DMA handle to the hi2c DMA Tx or Rx handle -+ (+++) Configure the priority and enable the NVIC for the transfer complete interrupt on -+ the DMA Tx or Rx Stream -+ -+ (#) Configure the Communication Speed, Duty cycle, Addressing mode, Own Address1, -+ Dual Addressing mode, Own Address2, General call and Nostretch mode in the hi2c Init structure. -+ -+ (#) Initialize the I2C registers by calling the HAL_I2C_Init(), configures also the low level Hardware -+ (GPIO, CLOCK, NVIC...etc) by calling the customized HAL_I2C_MspInit(&hi2c) API. -+ -+ (#) To check if target device is ready for communication, use the function HAL_I2C_IsDeviceReady() -+ -+ (#) For I2C IO and IO MEM operations, three operation modes are available within this driver : -+ -+ *** Polling mode IO operation *** -+ ================================= -+ [..] -+ (+) Transmit in master mode an amount of data in blocking mode using HAL_I2C_Master_Transmit() -+ (+) Receive in master mode an amount of data in blocking mode using HAL_I2C_Master_Receive() -+ (+) Transmit in slave mode an amount of data in blocking mode using HAL_I2C_Slave_Transmit() -+ (+) Receive in slave mode an amount of data in blocking mode using HAL_I2C_Slave_Receive() -+ -+ *** Polling mode IO MEM operation *** -+ ===================================== -+ [..] -+ (+) Write an amount of data in blocking mode to a specific memory address using HAL_I2C_Mem_Write() -+ (+) Read an amount of data in blocking mode from a specific memory address using HAL_I2C_Mem_Read() -+ -+ -+ *** Interrupt mode IO operation *** -+ =================================== -+ [..] -+ (+) Transmit in master mode an amount of data in non blocking mode using HAL_I2C_Master_Transmit_IT() -+ (+) At transmission end of transfer HAL_I2C_MasterTxCpltCallback is executed and user can -+ add his own code by customization of function pointer HAL_I2C_MasterTxCpltCallback -+ (+) Receive in master mode an amount of data in non blocking mode using HAL_I2C_Master_Receive_IT() -+ (+) At reception end of transfer HAL_I2C_MasterRxCpltCallback is executed and user can -+ add his own code by customization of function pointer HAL_I2C_MasterRxCpltCallback -+ (+) Transmit in slave mode an amount of data in non blocking mode using HAL_I2C_Slave_Transmit_IT() -+ (+) At transmission end of transfer HAL_I2C_SlaveTxCpltCallback is executed and user can -+ add his own code by customization of function pointer HAL_I2C_SlaveTxCpltCallback -+ (+) Receive in slave mode an amount of data in non blocking mode using HAL_I2C_Slave_Receive_IT() -+ (+) At reception end of transfer HAL_I2C_SlaveRxCpltCallback is executed and user can -+ add his own code by customization of function pointer HAL_I2C_SlaveRxCpltCallback -+ (+) In case of transfer Error, HAL_I2C_ErrorCallback() function is executed and user can -+ add his own code by customization of function pointer HAL_I2C_ErrorCallback -+ (+) Abort a master I2C process communication with Interrupt using HAL_I2C_Master_Abort_IT() -+ (+) End of abort process, HAL_I2C_AbortCpltCallback() is executed and user can -+ add his own code by customization of function pointer HAL_I2C_AbortCpltCallback() -+ -+ *** Interrupt mode IO sequential operation *** -+ ============================================== -+ [..] -+ (@) These interfaces allow to manage a sequential transfer with a repeated start condition -+ when a direction change during transfer -+ [..] -+ (+) A specific option field manage the different steps of a sequential transfer -+ (+) Option field values are defined through @ref I2C_XFEROPTIONS and are listed below: -+ (++) I2C_FIRST_AND_LAST_FRAME: No sequential usage, functionnal is same as associated interfaces in no sequential mode -+ (++) I2C_FIRST_FRAME: Sequential usage, this option allow to manage a sequence with start condition, address -+ and data to transfer without a final stop condition -+ (++) I2C_NEXT_FRAME: Sequential usage, this option allow to manage a sequence with a restart condition, address -+ and with new data to transfer if the direction change or manage only the new data to transfer -+ if no direction change and without a final stop condition in both cases -+ (++) I2C_LAST_FRAME: Sequential usage, this option allow to manage a sequance with a restart condition, address -+ and with new data to transfer if the direction change or manage only the new data to transfer -+ if no direction change and with a final stop condition in both cases -+ -+ (+) Differents sequential I2C interfaces are listed below: -+ (++) Sequential transmit in master I2C mode an amount of data in non-blocking mode using HAL_I2C_Master_Sequential_Transmit_IT() -+ (+++) At transmission end of current frame transfer, HAL_I2C_MasterTxCpltCallback() is executed and user can -+ add his own code by customization of function pointer HAL_I2C_MasterTxCpltCallback() -+ (++) Sequential receive in master I2C mode an amount of data in non-blocking mode using HAL_I2C_Master_Sequential_Receive_IT() -+ (+++) At reception end of current frame transfer, HAL_I2C_MasterRxCpltCallback() is executed and user can -+ add his own code by customization of function pointer HAL_I2C_MasterRxCpltCallback() -+ (++) Abort a master I2C process communication with Interrupt using HAL_I2C_Master_Abort_IT() -+ (+++) End of abort process, HAL_I2C_AbortCpltCallback() is executed and user can -+ add his own code by customization of function pointer HAL_I2C_AbortCpltCallback() -+ (++) Enable/disable the Address listen mode in slave I2C mode using HAL_I2C_EnableListen_IT() HAL_I2C_DisableListen_IT() -+ (+++) When address slave I2C match, HAL_I2C_AddrCallback() is executed and user can -+ add his own code to check the Address Match Code and the transmission direction request by master (Write/Read). -+ (+++) At Listen mode end HAL_I2C_ListenCpltCallback() is executed and user can -+ add his own code by customization of function pointer HAL_I2C_ListenCpltCallback() -+ (++) Sequential transmit in slave I2C mode an amount of data in non-blocking mode using HAL_I2C_Slave_Sequential_Transmit_IT() -+ (+++) At transmission end of current frame transfer, HAL_I2C_SlaveTxCpltCallback() is executed and user can -+ add his own code by customization of function pointer HAL_I2C_SlaveTxCpltCallback() -+ (++) Sequential receive in slave I2C mode an amount of data in non-blocking mode using HAL_I2C_Slave_Sequential_Receive_IT() -+ (+++) At reception end of current frame transfer, HAL_I2C_SlaveRxCpltCallback() is executed and user can -+ add his own code by customization of function pointer HAL_I2C_SlaveRxCpltCallback() -+ (++) In case of transfer Error, HAL_I2C_ErrorCallback() function is executed and user can -+ add his own code by customization of function pointer HAL_I2C_ErrorCallback() -+ (++) Abort a master I2C process communication with Interrupt using HAL_I2C_Master_Abort_IT() -+ (++) End of abort process, HAL_I2C_AbortCpltCallback() is executed and user can -+ add his own code by customization of function pointer HAL_I2C_AbortCpltCallback() -+ -+ *** Interrupt mode IO MEM operation *** -+ ======================================= -+ [..] -+ (+) Write an amount of data in no-blocking mode with Interrupt to a specific memory address using -+ HAL_I2C_Mem_Write_IT() -+ (+) At MEM end of write transfer HAL_I2C_MemTxCpltCallback is executed and user can -+ add his own code by customization of function pointer HAL_I2C_MemTxCpltCallback -+ (+) Read an amount of data in no-blocking mode with Interrupt from a specific memory address using -+ HAL_I2C_Mem_Read_IT() -+ (+) At MEM end of read transfer HAL_I2C_MemRxCpltCallback is executed and user can -+ add his own code by customization of function pointer HAL_I2C_MemRxCpltCallback -+ (+) In case of transfer Error, HAL_I2C_ErrorCallback() function is executed and user can -+ add his own code by customization of function pointer HAL_I2C_ErrorCallback -+ -+ *** DMA mode IO operation *** -+ ============================== -+ [..] -+ (+) Transmit in master mode an amount of data in non blocking mode (DMA) using -+ HAL_I2C_Master_Transmit_DMA() -+ (+) At transmission end of transfer HAL_I2C_MasterTxCpltCallback is executed and user can -+ add his own code by customization of function pointer HAL_I2C_MasterTxCpltCallback -+ (+) Receive in master mode an amount of data in non blocking mode (DMA) using -+ HAL_I2C_Master_Receive_DMA() -+ (+) At reception end of transfer HAL_I2C_MasterRxCpltCallback is executed and user can -+ add his own code by customization of function pointer HAL_I2C_MasterRxCpltCallback -+ (+) Transmit in slave mode an amount of data in non blocking mode (DMA) using -+ HAL_I2C_Slave_Transmit_DMA() -+ (+) At transmission end of transfer HAL_I2C_SlaveTxCpltCallback is executed and user can -+ add his own code by customization of function pointer HAL_I2C_SlaveTxCpltCallback -+ (+) Receive in slave mode an amount of data in non blocking mode (DMA) using -+ HAL_I2C_Slave_Receive_DMA() -+ (+) At reception end of transfer HAL_I2C_SlaveRxCpltCallback is executed and user can -+ add his own code by customization of function pointer HAL_I2C_SlaveRxCpltCallback -+ (+) In case of transfer Error, HAL_I2C_ErrorCallback() function is executed and user can -+ add his own code by customization of function pointer HAL_I2C_ErrorCallback -+ (+) Abort a master I2C process communication with Interrupt using HAL_I2C_Master_Abort_IT() -+ (+) End of abort process, HAL_I2C_AbortCpltCallback() is executed and user can -+ add his own code by customization of function pointer HAL_I2C_AbortCpltCallback() -+ -+ *** DMA mode IO MEM operation *** -+ ================================= -+ [..] -+ (+) Write an amount of data in no-blocking mode with DMA to a specific memory address using -+ HAL_I2C_Mem_Write_DMA() -+ (+) At MEM end of write transfer HAL_I2C_MemTxCpltCallback is executed and user can -+ add his own code by customization of function pointer HAL_I2C_MemTxCpltCallback -+ (+) Read an amount of data in no-blocking mode with DMA from a specific memory address using -+ HAL_I2C_Mem_Read_DMA() -+ (+) At MEM end of read transfer HAL_I2C_MemRxCpltCallback is executed and user can -+ add his own code by customization of function pointer HAL_I2C_MemRxCpltCallback -+ (+) In case of transfer Error, HAL_I2C_ErrorCallback() function is executed and user can -+ add his own code by customization of function pointer HAL_I2C_ErrorCallback -+ -+ -+ *** I2C HAL driver macros list *** -+ ================================== -+ [..] -+ Below the list of most used macros in I2C HAL driver. -+ -+ (+) __HAL_I2C_ENABLE: Enable the I2C peripheral -+ (+) __HAL_I2C_DISABLE: Disable the I2C peripheral -+ (+) __HAL_I2C_GET_FLAG : Checks whether the specified I2C flag is set or not -+ (+) __HAL_I2C_CLEAR_FLAG : Clear the specified I2C pending flag -+ (+) __HAL_I2C_ENABLE_IT: Enable the specified I2C interrupt -+ (+) __HAL_I2C_DISABLE_IT: Disable the specified I2C interrupt -+ -+ [..] -+ (@) You can refer to the I2C HAL driver header file for more useful macros -+ -+ -+ @endverbatim -+ ****************************************************************************** -+ * @attention -+ * -+ *

© COPYRIGHT(c) 2017 STMicroelectronics

-+ * -+ * Redistribution and use in source and binary forms, with or without modification, -+ * are permitted provided that the following conditions are met: -+ * 1. Redistributions of source code must retain the above copyright notice, -+ * this list of conditions and the following disclaimer. -+ * 2. Redistributions in binary form must reproduce the above copyright notice, -+ * this list of conditions and the following disclaimer in the documentation -+ * and/or other materials provided with the distribution. -+ * 3. Neither the name of STMicroelectronics nor the names of its contributors -+ * may be used to endorse or promote products derived from this software -+ * without specific prior written permission. -+ * -+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" -+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE -+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE -+ * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE -+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL -+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR -+ * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER -+ * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, -+ * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE -+ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. -+ * -+ ****************************************************************************** -+ */ -+ -+/* Includes ------------------------------------------------------------------*/ -+#include "stm32f4xx_hal.h" -+ -+/** @addtogroup STM32F4xx_HAL_Driver -+ * @{ -+ */ -+ -+/** @defgroup I2C I2C -+ * @brief I2C HAL module driver -+ * @{ -+ */ -+ -+#ifdef HAL_I2C_MODULE_ENABLED -+ -+/* Private typedef -----------------------------------------------------------*/ -+/* Private define ------------------------------------------------------------*/ -+/** @addtogroup I2C_Private_Define -+ * @{ -+ */ -+#define I2C_TIMEOUT_FLAG 35U /*!< Timeout 35 ms */ -+#define I2C_TIMEOUT_BUSY_FLAG 25U /*!< Timeout 25 ms */ -+#define I2C_NO_OPTION_FRAME 0xFFFF0000U /*!< XferOptions default value */ -+ -+/* Private define for @ref PreviousState usage */ -+#define I2C_STATE_MSK ((uint32_t)((HAL_I2C_STATE_BUSY_TX | HAL_I2C_STATE_BUSY_RX) & (~(uint32_t)HAL_I2C_STATE_READY))) /*!< Mask State define, keep only RX and TX bits */ -+#define I2C_STATE_NONE ((uint32_t)(HAL_I2C_MODE_NONE)) /*!< Default Value */ -+#define I2C_STATE_MASTER_BUSY_TX ((uint32_t)((HAL_I2C_STATE_BUSY_TX & I2C_STATE_MSK) | HAL_I2C_MODE_MASTER)) /*!< Master Busy TX, combinaison of State LSB and Mode enum */ -+#define I2C_STATE_MASTER_BUSY_RX ((uint32_t)((HAL_I2C_STATE_BUSY_RX & I2C_STATE_MSK) | HAL_I2C_MODE_MASTER)) /*!< Master Busy RX, combinaison of State LSB and Mode enum */ -+#define I2C_STATE_SLAVE_BUSY_TX ((uint32_t)((HAL_I2C_STATE_BUSY_TX & I2C_STATE_MSK) | HAL_I2C_MODE_SLAVE)) /*!< Slave Busy TX, combinaison of State LSB and Mode enum */ -+#define I2C_STATE_SLAVE_BUSY_RX ((uint32_t)((HAL_I2C_STATE_BUSY_RX & I2C_STATE_MSK) | HAL_I2C_MODE_SLAVE)) /*!< Slave Busy RX, combinaison of State LSB and Mode enum */ -+ -+/** -+ * @} -+ */ -+ -+/* Private macro -------------------------------------------------------------*/ -+/* Private variables ---------------------------------------------------------*/ -+/* Private function prototypes -----------------------------------------------*/ -+/** @addtogroup I2C_Private_Functions -+ * @{ -+ */ -+/* Private functions to handle DMA transfer */ -+static void I2C_DMAXferCplt(DMA_HandleTypeDef *hdma); -+static void I2C_DMAError(DMA_HandleTypeDef *hdma); -+static void I2C_DMAAbort(DMA_HandleTypeDef *hdma); -+ -+static void I2C_ITError(I2C_HandleTypeDef *hi2c); -+ -+static HAL_StatusTypeDef I2C_MasterRequestWrite(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint32_t Timeout, uint32_t Tickstart); -+static HAL_StatusTypeDef I2C_MasterRequestRead(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint32_t Timeout, uint32_t Tickstart); -+static HAL_StatusTypeDef I2C_RequestMemoryWrite(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint32_t Timeout, uint32_t Tickstart); -+static HAL_StatusTypeDef I2C_RequestMemoryRead(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint32_t Timeout, uint32_t Tickstart); -+static HAL_StatusTypeDef I2C_WaitOnFlagUntilTimeout(I2C_HandleTypeDef *hi2c, uint32_t Flag, FlagStatus Status, uint32_t Timeout, uint32_t Tickstart); -+static HAL_StatusTypeDef I2C_WaitOnMasterAddressFlagUntilTimeout(I2C_HandleTypeDef *hi2c, uint32_t Flag, uint32_t Timeout, uint32_t Tickstart); -+static HAL_StatusTypeDef I2C_WaitOnTXEFlagUntilTimeout(I2C_HandleTypeDef *hi2c, uint32_t Timeout, uint32_t Tickstart); -+static HAL_StatusTypeDef I2C_WaitOnBTFFlagUntilTimeout(I2C_HandleTypeDef *hi2c, uint32_t Timeout, uint32_t Tickstart); -+static HAL_StatusTypeDef I2C_WaitOnRXNEFlagUntilTimeout(I2C_HandleTypeDef *hi2c, uint32_t Timeout, uint32_t Tickstart); -+static HAL_StatusTypeDef I2C_WaitOnSTOPFlagUntilTimeout(I2C_HandleTypeDef *hi2c, uint32_t Timeout, uint32_t Tickstart); -+static HAL_StatusTypeDef I2C_IsAcknowledgeFailed(I2C_HandleTypeDef *hi2c); -+ -+/* Private functions for I2C transfer IRQ handler */ -+static HAL_StatusTypeDef I2C_MasterTransmit_TXE(I2C_HandleTypeDef *hi2c); -+static HAL_StatusTypeDef I2C_MasterTransmit_BTF(I2C_HandleTypeDef *hi2c); -+static HAL_StatusTypeDef I2C_MasterReceive_RXNE(I2C_HandleTypeDef *hi2c); -+static HAL_StatusTypeDef I2C_MasterReceive_BTF(I2C_HandleTypeDef *hi2c); -+static HAL_StatusTypeDef I2C_Master_SB(I2C_HandleTypeDef *hi2c); -+static HAL_StatusTypeDef I2C_Master_ADD10(I2C_HandleTypeDef *hi2c); -+static HAL_StatusTypeDef I2C_Master_ADDR(I2C_HandleTypeDef *hi2c); -+ -+static HAL_StatusTypeDef I2C_SlaveTransmit_TXE(I2C_HandleTypeDef *hi2c); -+static HAL_StatusTypeDef I2C_SlaveTransmit_BTF(I2C_HandleTypeDef *hi2c); -+static HAL_StatusTypeDef I2C_SlaveReceive_RXNE(I2C_HandleTypeDef *hi2c); -+static HAL_StatusTypeDef I2C_SlaveReceive_BTF(I2C_HandleTypeDef *hi2c); -+static HAL_StatusTypeDef I2C_Slave_ADDR(I2C_HandleTypeDef *hi2c); -+static HAL_StatusTypeDef I2C_Slave_STOPF(I2C_HandleTypeDef *hi2c); -+static HAL_StatusTypeDef I2C_Slave_AF(I2C_HandleTypeDef *hi2c); -+/** -+ * @} -+ */ -+ -+/* Exported functions --------------------------------------------------------*/ -+/** @defgroup I2C_Exported_Functions I2C Exported Functions -+ * @{ -+ */ -+ -+/** @defgroup I2C_Exported_Functions_Group1 Initialization and de-initialization functions -+ * @brief Initialization and Configuration functions -+ * -+@verbatim -+ =============================================================================== -+ ##### Initialization and de-initialization functions ##### -+ =============================================================================== -+ [..] This subsection provides a set of functions allowing to initialize and -+ de-initialize the I2Cx peripheral: -+ -+ (+) User must Implement HAL_I2C_MspInit() function in which he configures -+ all related peripherals resources (CLOCK, GPIO, DMA, IT and NVIC). -+ -+ (+) Call the function HAL_I2C_Init() to configure the selected device with -+ the selected configuration: -+ (++) Communication Speed -+ (++) Duty cycle -+ (++) Addressing mode -+ (++) Own Address 1 -+ (++) Dual Addressing mode -+ (++) Own Address 2 -+ (++) General call mode -+ (++) Nostretch mode -+ -+ (+) Call the function HAL_I2C_DeInit() to restore the default configuration -+ of the selected I2Cx peripheral. -+ -+@endverbatim -+ * @{ -+ */ -+ -+/** -+ * @brief Initializes the I2C according to the specified parameters -+ * in the I2C_InitTypeDef and create the associated handle. -+ * @param hi2c pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Init(I2C_HandleTypeDef *hi2c) -+{ -+ uint32_t freqrange = 0U; -+ uint32_t pclk1 = 0U; -+ -+ /* Check the I2C handle allocation */ -+ if(hi2c == NULL) -+ { -+ return HAL_ERROR; -+ } -+ -+ /* Check the parameters */ -+ assert_param(IS_I2C_ALL_INSTANCE(hi2c->Instance)); -+ assert_param(IS_I2C_CLOCK_SPEED(hi2c->Init.ClockSpeed)); -+ assert_param(IS_I2C_DUTY_CYCLE(hi2c->Init.DutyCycle)); -+ assert_param(IS_I2C_OWN_ADDRESS1(hi2c->Init.OwnAddress1)); -+ assert_param(IS_I2C_ADDRESSING_MODE(hi2c->Init.AddressingMode)); -+ assert_param(IS_I2C_DUAL_ADDRESS(hi2c->Init.DualAddressMode)); -+ assert_param(IS_I2C_OWN_ADDRESS2(hi2c->Init.OwnAddress2)); -+ assert_param(IS_I2C_GENERAL_CALL(hi2c->Init.GeneralCallMode)); -+ assert_param(IS_I2C_NO_STRETCH(hi2c->Init.NoStretchMode)); -+ -+ if(hi2c->State == HAL_I2C_STATE_RESET) -+ { -+ /* Allocate lock resource and initialize it */ -+ hi2c->Lock = HAL_UNLOCKED; -+ /* Init the low level hardware : GPIO, CLOCK, NVIC */ -+ HAL_I2C_MspInit(hi2c); -+ } -+ -+ hi2c->State = HAL_I2C_STATE_BUSY; -+ -+ /* Disable the selected I2C peripheral */ -+ __HAL_I2C_DISABLE(hi2c); -+ -+ /* Get PCLK1 frequency */ -+ pclk1 = HAL_RCC_GetPCLK1Freq(); -+ -+ /* Calculate frequency range */ -+ freqrange = I2C_FREQRANGE(pclk1); -+ -+ /*---------------------------- I2Cx CR2 Configuration ----------------------*/ -+ /* Configure I2Cx: Frequency range */ -+ hi2c->Instance->CR2 = freqrange; -+ -+ /*---------------------------- I2Cx TRISE Configuration --------------------*/ -+ /* Configure I2Cx: Rise Time */ -+ hi2c->Instance->TRISE = I2C_RISE_TIME(freqrange, hi2c->Init.ClockSpeed); -+ -+ /*---------------------------- I2Cx CCR Configuration ----------------------*/ -+ /* Configure I2Cx: Speed */ -+ hi2c->Instance->CCR = I2C_SPEED(pclk1, hi2c->Init.ClockSpeed, hi2c->Init.DutyCycle); -+ -+ /*---------------------------- I2Cx CR1 Configuration ----------------------*/ -+ /* Configure I2Cx: Generalcall and NoStretch mode */ -+ hi2c->Instance->CR1 = (hi2c->Init.GeneralCallMode | hi2c->Init.NoStretchMode); -+ -+ /*---------------------------- I2Cx OAR1 Configuration ---------------------*/ -+ /* Configure I2Cx: Own Address1 and addressing mode */ -+ hi2c->Instance->OAR1 = (hi2c->Init.AddressingMode | hi2c->Init.OwnAddress1); -+ -+ /*---------------------------- I2Cx OAR2 Configuration ---------------------*/ -+ /* Configure I2Cx: Dual mode and Own Address2 */ -+ hi2c->Instance->OAR2 = (hi2c->Init.DualAddressMode | hi2c->Init.OwnAddress2); -+ -+ /* Enable the selected I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ return HAL_OK; -+} -+ -+/** -+ * @brief DeInitializes the I2C peripheral. -+ * @param hi2c pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_DeInit(I2C_HandleTypeDef *hi2c) -+{ -+ /* Check the I2C handle allocation */ -+ if(hi2c == NULL) -+ { -+ return HAL_ERROR; -+ } -+ -+ /* Check the parameters */ -+ assert_param(IS_I2C_ALL_INSTANCE(hi2c->Instance)); -+ -+ hi2c->State = HAL_I2C_STATE_BUSY; -+ -+ /* Disable the I2C Peripheral Clock */ -+ __HAL_I2C_DISABLE(hi2c); -+ -+ /* DeInit the low level hardware: GPIO, CLOCK, NVIC */ -+ HAL_I2C_MspDeInit(hi2c); -+ -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ hi2c->State = HAL_I2C_STATE_RESET; -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Release Lock */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_OK; -+} -+ -+/** -+ * @brief I2C MSP Init. -+ * @param hi2c pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval None -+ */ -+ __weak void HAL_I2C_MspInit(I2C_HandleTypeDef *hi2c) -+{ -+ /* Prevent unused argument(s) compilation warning */ -+ UNUSED(hi2c); -+ /* NOTE : This function Should not be modified, when the callback is needed, -+ the HAL_I2C_MspInit could be implemented in the user file -+ */ -+} -+ -+/** -+ * @brief I2C MSP DeInit -+ * @param hi2c pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval None -+ */ -+ __weak void HAL_I2C_MspDeInit(I2C_HandleTypeDef *hi2c) -+{ -+ /* Prevent unused argument(s) compilation warning */ -+ UNUSED(hi2c); -+ /* NOTE : This function Should not be modified, when the callback is needed, -+ the HAL_I2C_MspDeInit could be implemented in the user file -+ */ -+} -+ -+/** -+ * @} -+ */ -+ -+/** @defgroup I2C_Exported_Functions_Group2 IO operation functions -+ * @brief Data transfers functions -+ * -+@verbatim -+ =============================================================================== -+ ##### IO operation functions ##### -+ =============================================================================== -+ [..] -+ This subsection provides a set of functions allowing to manage the I2C data -+ transfers. -+ -+ (#) There are two modes of transfer: -+ (++) Blocking mode : The communication is performed in the polling mode. -+ The status of all data processing is returned by the same function -+ after finishing transfer. -+ (++) No-Blocking mode : The communication is performed using Interrupts -+ or DMA. These functions return the status of the transfer startup. -+ The end of the data processing will be indicated through the -+ dedicated I2C IRQ when using Interrupt mode or the DMA IRQ when -+ using DMA mode. -+ -+ (#) Blocking mode functions are : -+ (++) HAL_I2C_Master_Transmit() -+ (++) HAL_I2C_Master_Receive() -+ (++) HAL_I2C_Slave_Transmit() -+ (++) HAL_I2C_Slave_Receive() -+ (++) HAL_I2C_Mem_Write() -+ (++) HAL_I2C_Mem_Read() -+ (++) HAL_I2C_IsDeviceReady() -+ -+ (#) No-Blocking mode functions with Interrupt are : -+ (++) HAL_I2C_Master_Transmit_IT() -+ (++) HAL_I2C_Master_Receive_IT() -+ (++) HAL_I2C_Slave_Transmit_IT() -+ (++) HAL_I2C_Slave_Receive_IT() -+ (++) HAL_I2C_Master_Sequential_Transmit_IT() -+ (++) HAL_I2C_Master_Sequential_Receive_IT() -+ (++) HAL_I2C_Slave_Sequential_Transmit_IT() -+ (++) HAL_I2C_Slave_Sequential_Receive_IT() -+ (++) HAL_I2C_Mem_Write_IT() -+ (++) HAL_I2C_Mem_Read_IT() -+ -+ (#) No-Blocking mode functions with DMA are : -+ (++) HAL_I2C_Master_Transmit_DMA() -+ (++) HAL_I2C_Master_Receive_DMA() -+ (++) HAL_I2C_Slave_Transmit_DMA() -+ (++) HAL_I2C_Slave_Receive_DMA() -+ (++) HAL_I2C_Mem_Write_DMA() -+ (++) HAL_I2C_Mem_Read_DMA() -+ -+ (#) A set of Transfer Complete Callbacks are provided in non Blocking mode: -+ (++) HAL_I2C_MemTxCpltCallback() -+ (++) HAL_I2C_MemRxCpltCallback() -+ (++) HAL_I2C_MasterTxCpltCallback() -+ (++) HAL_I2C_MasterRxCpltCallback() -+ (++) HAL_I2C_SlaveTxCpltCallback() -+ (++) HAL_I2C_SlaveRxCpltCallback() -+ (++) HAL_I2C_ErrorCallback() -+ (++) HAL_I2C_AbortCpltCallback() -+ -+@endverbatim -+ * @{ -+ */ -+ -+/** -+ * @brief Transmits in master mode an amount of data in blocking mode. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address The device 7 bits address value -+ * in datasheet must be shifted to the left before calling the interface -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @param Timeout Timeout duration -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Master_Transmit(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size, uint32_t Timeout) -+{ -+ uint32_t tickstart = 0x00U; -+ -+ /* Init tickstart for timeout management*/ -+ tickstart = HAL_GetTick(); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Wait until BUSY flag is reset */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_BUSY, SET, I2C_TIMEOUT_BUSY_FLAG, tickstart) != HAL_OK) -+ { -+ return HAL_BUSY; -+ } -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_TX; -+ hi2c->Mode = HAL_I2C_MODE_MASTER; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ -+ /* Send Slave Address */ -+ if(I2C_MasterRequestWrite(hi2c, DevAddress, Timeout, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_ERROR; -+ } -+ else -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ while(hi2c->XferSize > 0U) -+ { -+ /* Wait until TXE flag is set */ -+ if(I2C_WaitOnTXEFlagUntilTimeout(hi2c, Timeout, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Write data to DR */ -+ hi2c->Instance->DR = (*hi2c->pBuffPtr++); -+ hi2c->XferCount--; -+ hi2c->XferSize--; -+ -+ if((__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BTF) == SET) && (hi2c->XferSize != 0U)) -+ { -+ /* Write data to DR */ -+ hi2c->Instance->DR = (*hi2c->pBuffPtr++); -+ hi2c->XferCount--; -+ hi2c->XferSize--; -+ } -+ -+ /* Wait until BTF flag is set */ -+ if(I2C_WaitOnBTFFlagUntilTimeout(hi2c, Timeout, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ } -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Receives in master mode an amount of data in blocking mode. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address The device 7 bits address value -+ * in datasheet must be shifted to the left before calling the interface -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @param Timeout Timeout duration -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Master_Receive(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size, uint32_t Timeout) -+{ -+ uint32_t tickstart = 0x00U; -+ -+ /* Init tickstart for timeout management*/ -+ tickstart = HAL_GetTick(); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Wait until BUSY flag is reset */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_BUSY, SET, I2C_TIMEOUT_BUSY_FLAG, tickstart) != HAL_OK) -+ { -+ return HAL_BUSY; -+ } -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_RX; -+ hi2c->Mode = HAL_I2C_MODE_MASTER; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ -+ /* Send Slave Address */ -+ if(I2C_MasterRequestRead(hi2c, DevAddress, Timeout, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_ERROR; -+ } -+ else -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ if(hi2c->XferSize == 0U) -+ { -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ } -+ else if(hi2c->XferSize == 1U) -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ } -+ else if(hi2c->XferSize == 2U) -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Enable Pos */ -+ hi2c->Instance->CR1 |= I2C_CR1_POS; -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ } -+ else -+ { -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ } -+ -+ while(hi2c->XferSize > 0U) -+ { -+ if(hi2c->XferSize <= 3U) -+ { -+ /* One byte */ -+ if(hi2c->XferSize == 1U) -+ { -+ /* Wait until RXNE flag is set */ -+ if(I2C_WaitOnRXNEFlagUntilTimeout(hi2c, Timeout, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_TIMEOUT) -+ { -+ return HAL_TIMEOUT; -+ } -+ else -+ { -+ return HAL_ERROR; -+ } -+ } -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ } -+ /* Two bytes */ -+ else if(hi2c->XferSize == 2U) -+ { -+ /* Wait until BTF flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_BTF, RESET, Timeout, tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ } -+ /* 3 Last bytes */ -+ else -+ { -+ /* Wait until BTF flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_BTF, RESET, Timeout, tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ -+ /* Wait until BTF flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_BTF, RESET, Timeout, tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ } -+ } -+ else -+ { -+ /* Wait until RXNE flag is set */ -+ if(I2C_WaitOnRXNEFlagUntilTimeout(hi2c, Timeout, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_TIMEOUT) -+ { -+ return HAL_TIMEOUT; -+ } -+ else -+ { -+ return HAL_ERROR; -+ } -+ } -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ -+ if(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BTF) == SET) -+ { -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ } -+ } -+ } -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Transmits in slave mode an amount of data in blocking mode. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @param Timeout Timeout duration -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Slave_Transmit(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size, uint32_t Timeout) -+{ -+ uint32_t tickstart = 0x00U; -+ -+ /* Init tickstart for timeout management*/ -+ tickstart = HAL_GetTick(); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ if((pData == NULL) || (Size == 0U)) -+ { -+ return HAL_ERROR; -+ } -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_TX; -+ hi2c->Mode = HAL_I2C_MODE_SLAVE; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ -+ /* Enable Address Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Wait until ADDR flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_ADDR, RESET, Timeout, tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* If 10bit addressing mode is selected */ -+ if(hi2c->Init.AddressingMode == I2C_ADDRESSINGMODE_10BIT) -+ { -+ /* Wait until ADDR flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_ADDR, RESET, Timeout, tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ } -+ -+ while(hi2c->XferSize > 0U) -+ { -+ /* Wait until TXE flag is set */ -+ if(I2C_WaitOnTXEFlagUntilTimeout(hi2c, Timeout, tickstart) != HAL_OK) -+ { -+ /* Disable Address Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Write data to DR */ -+ hi2c->Instance->DR = (*hi2c->pBuffPtr++); -+ hi2c->XferCount--; -+ hi2c->XferSize--; -+ -+ if((__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BTF) == SET) && (hi2c->XferSize != 0U)) -+ { -+ /* Write data to DR */ -+ hi2c->Instance->DR = (*hi2c->pBuffPtr++); -+ hi2c->XferCount--; -+ hi2c->XferSize--; -+ } -+ } -+ -+ /* Wait until AF flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_AF, RESET, Timeout, tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Clear AF flag */ -+ __HAL_I2C_CLEAR_FLAG(hi2c, I2C_FLAG_AF); -+ -+ /* Disable Address Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Receive in slave mode an amount of data in blocking mode -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @param Timeout Timeout duration -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Slave_Receive(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size, uint32_t Timeout) -+{ -+ uint32_t tickstart = 0x00U; -+ -+ /* Init tickstart for timeout management*/ -+ tickstart = HAL_GetTick(); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ if((pData == NULL) || (Size == 0)) -+ { -+ return HAL_ERROR; -+ } -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_RX; -+ hi2c->Mode = HAL_I2C_MODE_SLAVE; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ -+ /* Enable Address Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Wait until ADDR flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_ADDR, RESET, Timeout, tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ while(hi2c->XferSize > 0U) -+ { -+ /* Wait until RXNE flag is set */ -+ if(I2C_WaitOnRXNEFlagUntilTimeout(hi2c, Timeout, tickstart) != HAL_OK) -+ { -+ /* Disable Address Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_TIMEOUT) -+ { -+ return HAL_TIMEOUT; -+ } -+ else -+ { -+ return HAL_ERROR; -+ } -+ } -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ -+ if((__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BTF) == SET) && (Size != 0U)) -+ { -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ } -+ } -+ -+ /* Wait until STOP flag is set */ -+ if(I2C_WaitOnSTOPFlagUntilTimeout(hi2c, Timeout, tickstart) != HAL_OK) -+ { -+ /* Disable Address Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Clear STOP flag */ -+ __HAL_I2C_CLEAR_STOPFLAG(hi2c); -+ -+ /* Disable Address Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Transmit in master mode an amount of data in non-blocking mode with Interrupt -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address The device 7 bits address value -+ * in datasheet must be shifted to the left before calling the interface -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Master_Transmit_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size) -+{ -+ __IO uint32_t count = 0U; -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_TX; -+ hi2c->Mode = HAL_I2C_MODE_MASTER; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ hi2c->Devaddress = DevAddress; -+ -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ /* Enable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Receive in master mode an amount of data in non-blocking mode with Interrupt -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address The device 7 bits address value -+ * in datasheet must be shifted to the left before calling the interface -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Master_Receive_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size) -+{ -+ __IO uint32_t count = 0U; -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_RX; -+ hi2c->Mode = HAL_I2C_MODE_MASTER; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ hi2c->Devaddress = DevAddress; -+ -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ -+ /* Enable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Sequential transmit in master mode an amount of data in non-blocking mode with Interrupt -+ * @note This interface allow to manage repeated start condition when a direction change during transfer -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address The device 7 bits address value -+ * in datasheet must be shifted to the left before calling the interface -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @param XferOptions Options of Transfer, value of @ref I2C_XferOptions_definition -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Master_Sequential_Transmit_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size, uint32_t XferOptions) -+{ -+ __IO uint32_t Prev_State = 0x00U; -+ __IO uint32_t count = 0x00U; -+ -+ /* Check the parameters */ -+ assert_param(IS_I2C_TRANSFER_OPTIONS_REQUEST(XferOptions)); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Check Busy Flag only if FIRST call of Master interface */ -+ if((XferOptions == I2C_FIRST_AND_LAST_FRAME) || (XferOptions == I2C_FIRST_FRAME)) -+ { -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ } -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_TX; -+ hi2c->Mode = HAL_I2C_MODE_MASTER; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = XferOptions; -+ hi2c->XferSize = hi2c->XferCount; -+ hi2c->Devaddress = DevAddress; -+ -+ Prev_State = hi2c->PreviousState; -+ -+ /* Generate Start */ -+ if((Prev_State == I2C_STATE_MASTER_BUSY_RX) || (Prev_State == I2C_STATE_NONE)) -+ { -+ /* Generate Start condition if first transfer */ -+ if((XferOptions == I2C_FIRST_AND_LAST_FRAME) || (XferOptions == I2C_FIRST_FRAME)) -+ { -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ } -+ else -+ { -+ /* Generate ReStart */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ } -+ } -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ -+ /* Enable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Sequential receive in master mode an amount of data in non-blocking mode with Interrupt -+ * @note This interface allow to manage repeated start condition when a direction change during transfer -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address The device 7 bits address value -+ * in datasheet must be shifted to the left before calling the interface -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @param XferOptions Options of Transfer, value of @ref I2C_XferOptions_definition -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Master_Sequential_Receive_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size, uint32_t XferOptions) -+{ -+ __IO uint32_t count = 0U; -+ -+ /* Check the parameters */ -+ assert_param(IS_I2C_TRANSFER_OPTIONS_REQUEST(XferOptions)); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Check Busy Flag only if FIRST call of Master interface */ -+ if((XferOptions == I2C_FIRST_AND_LAST_FRAME) || (XferOptions == I2C_FIRST_FRAME)) -+ { -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ } -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_RX; -+ hi2c->Mode = HAL_I2C_MODE_MASTER; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = XferOptions; -+ hi2c->XferSize = hi2c->XferCount; -+ hi2c->Devaddress = DevAddress; -+ -+ if((hi2c->PreviousState == I2C_STATE_MASTER_BUSY_TX) || (hi2c->PreviousState == I2C_STATE_NONE)) -+ { -+ /* Generate Start condition if first transfer */ -+ if((XferOptions == I2C_FIRST_AND_LAST_FRAME) || (XferOptions == I2C_FIRST_FRAME) || (XferOptions == I2C_NO_OPTION_FRAME)) -+ { -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ } -+ else if(hi2c->PreviousState == I2C_STATE_MASTER_BUSY_TX) -+ { -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Generate ReStart */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ } -+ } -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ -+ /* Enable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Transmit in slave mode an amount of data in non-blocking mode with Interrupt -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Slave_Transmit_IT(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size) -+{ -+ __IO uint32_t count = 0U; -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ if((pData == NULL) || (Size == 0U)) -+ { -+ return HAL_ERROR; -+ } -+ -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_TX; -+ hi2c->Mode = HAL_I2C_MODE_SLAVE; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ -+ /* Enable Address Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ -+ /* Enable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Receive in slave mode an amount of data in non-blocking mode with Interrupt -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Slave_Receive_IT(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size) -+{ -+ __IO uint32_t count = 0U; -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ if((pData == NULL) || (Size == 0U)) -+ { -+ return HAL_ERROR; -+ } -+ -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_RX; -+ hi2c->Mode = HAL_I2C_MODE_SLAVE; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferSize = Size; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ -+ /* Enable Address Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ -+ /* Enable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Sequential transmit in slave mode an amount of data in no-blocking mode with Interrupt -+ * @note This interface allow to manage repeated start condition when a direction change during transfer -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @param XferOptions Options of Transfer, value of @ref I2C_XferOptions_definition -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Slave_Sequential_Transmit_IT(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size, uint32_t XferOptions) -+{ -+ /* Check the parameters */ -+ assert_param(IS_I2C_TRANSFER_OPTIONS_REQUEST(XferOptions)); -+ -+ if(hi2c->State == HAL_I2C_STATE_LISTEN) -+ { -+ if((pData == NULL) || (Size == 0U)) -+ { -+ return HAL_ERROR; -+ } -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_TX_LISTEN; -+ hi2c->Mode = HAL_I2C_MODE_SLAVE; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = XferOptions; -+ hi2c->XferSize = hi2c->XferCount; -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ -+ /* Enable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Sequential receive in slave mode an amount of data in non-blocking mode with Interrupt -+ * @note This interface allow to manage repeated start condition when a direction change during transfer -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @param XferOptions Options of Transfer, value of @ref I2C_XferOptions_definition -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Slave_Sequential_Receive_IT(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size, uint32_t XferOptions) -+{ -+ /* Check the parameters */ -+ assert_param(IS_I2C_TRANSFER_OPTIONS_REQUEST(XferOptions)); -+ -+ if(hi2c->State == HAL_I2C_STATE_LISTEN) -+ { -+ if((pData == NULL) || (Size == 0U)) -+ { -+ return HAL_ERROR; -+ } -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_RX_LISTEN; -+ hi2c->Mode = HAL_I2C_MODE_SLAVE; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = XferOptions; -+ hi2c->XferSize = hi2c->XferCount; -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ -+ /* Enable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Enable the Address listen mode with Interrupt. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_EnableListen_IT(I2C_HandleTypeDef *hi2c) -+{ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ hi2c->State = HAL_I2C_STATE_LISTEN; -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Enable Address Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Enable EVT and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_ERR); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Disable the Address listen mode with Interrupt. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_DisableListen_IT(I2C_HandleTypeDef *hi2c) -+{ -+ /* Declaration of tmp to prevent undefined behavior of volatile usage */ -+ uint32_t tmp; -+ -+ /* Disable Address listen mode only if a transfer is not ongoing */ -+ if(hi2c->State == HAL_I2C_STATE_LISTEN) -+ { -+ tmp = (uint32_t)(hi2c->State) & I2C_STATE_MSK; -+ hi2c->PreviousState = tmp | (uint32_t)(hi2c->Mode); -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Disable Address Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Disable EVT and ERR interrupt */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_ERR); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Transmit in master mode an amount of data in non-blocking mode with DMA -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address The device 7 bits address value -+ * in datasheet must be shifted to the left before calling the interface -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Master_Transmit_DMA(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size) -+{ -+ __IO uint32_t count = 0U; -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_TX; -+ hi2c->Mode = HAL_I2C_MODE_MASTER; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ hi2c->Devaddress = DevAddress; -+ -+ if(hi2c->XferSize > 0U) -+ { -+ /* Set the I2C DMA transfer complete callback */ -+ hi2c->hdmatx->XferCpltCallback = I2C_DMAXferCplt; -+ -+ /* Set the DMA error callback */ -+ hi2c->hdmatx->XferErrorCallback = I2C_DMAError; -+ -+ /* Set the unused DMA callbacks to NULL */ -+ hi2c->hdmatx->XferHalfCpltCallback = NULL; -+ hi2c->hdmatx->XferM1CpltCallback = NULL; -+ hi2c->hdmatx->XferM1HalfCpltCallback = NULL; -+ hi2c->hdmatx->XferAbortCallback = NULL; -+ -+ /* Enable the DMA Stream */ -+ HAL_DMA_Start_IT(hi2c->hdmatx, (uint32_t)hi2c->pBuffPtr, (uint32_t)&hi2c->Instance->DR, hi2c->XferSize); -+ -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ -+ /* Enable EVT and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_ERR); -+ -+ /* Enable DMA Request */ -+ hi2c->Instance->CR2 |= I2C_CR2_DMAEN; -+ } -+ else -+ { -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ -+ /* Enable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ } -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Receive in master mode an amount of data in non-blocking mode with DMA -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address The device 7 bits address value -+ * in datasheet must be shifted to the left before calling the interface -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Master_Receive_DMA(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData, uint16_t Size) -+{ -+ __IO uint32_t count = 0U; -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_RX; -+ hi2c->Mode = HAL_I2C_MODE_MASTER; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ hi2c->Devaddress = DevAddress; -+ -+ if(hi2c->XferSize > 0U) -+ { -+ /* Set the I2C DMA transfer complete callback */ -+ hi2c->hdmarx->XferCpltCallback = I2C_DMAXferCplt; -+ -+ /* Set the DMA error callback */ -+ hi2c->hdmarx->XferErrorCallback = I2C_DMAError; -+ -+ /* Set the unused DMA callbacks to NULL */ -+ hi2c->hdmarx->XferHalfCpltCallback = NULL; -+ hi2c->hdmarx->XferM1CpltCallback = NULL; -+ hi2c->hdmarx->XferM1HalfCpltCallback = NULL; -+ hi2c->hdmarx->XferAbortCallback = NULL; -+ -+ /* Enable the DMA Stream */ -+ HAL_DMA_Start_IT(hi2c->hdmarx, (uint32_t)&hi2c->Instance->DR, (uint32_t)hi2c->pBuffPtr, hi2c->XferSize); -+ -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ -+ /* Enable EVT and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_ERR); -+ -+ /* Enable DMA Request */ -+ hi2c->Instance->CR2 |= I2C_CR2_DMAEN; -+ } -+ else -+ { -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ -+ /* Enable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ } -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Abort a master I2C process communication with Interrupt. -+ * @note This abort can be called only if state is ready -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address The device 7 bits address value -+ * in datasheet must be shifted to the left before calling the interface -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Master_Abort_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress) -+{ -+ /* Prevent unused argument(s) compilation warning */ -+ UNUSED(DevAddress); -+ -+ /* Abort Master transfer during Receive or Transmit process */ -+ if(hi2c->Mode == HAL_I2C_MODE_MASTER) -+ { -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State = HAL_I2C_STATE_ABORT; -+ -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ hi2c->XferCount = 0U; -+ -+ /* Disable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Call the corresponding callback to inform upper layer of End of Transfer */ -+ I2C_ITError(hi2c); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ /* Wrong usage of abort function */ -+ /* This function should be used only in case of abort monitored by master device */ -+ return HAL_ERROR; -+ } -+} -+ -+/** -+ * @brief Transmit in slave mode an amount of data in non-blocking mode with DMA -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Slave_Transmit_DMA(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size) -+{ -+ __IO uint32_t count = 0U; -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ if((pData == NULL) || (Size == 0U)) -+ { -+ return HAL_ERROR; -+ } -+ -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_TX; -+ hi2c->Mode = HAL_I2C_MODE_SLAVE; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ -+ /* Set the I2C DMA transfer complete callback */ -+ hi2c->hdmatx->XferCpltCallback = I2C_DMAXferCplt; -+ -+ /* Set the DMA error callback */ -+ hi2c->hdmatx->XferErrorCallback = I2C_DMAError; -+ -+ /* Set the unused DMA callbacks to NULL */ -+ hi2c->hdmatx->XferHalfCpltCallback = NULL; -+ hi2c->hdmatx->XferM1CpltCallback = NULL; -+ hi2c->hdmatx->XferM1HalfCpltCallback = NULL; -+ hi2c->hdmatx->XferAbortCallback = NULL; -+ -+ /* Enable the DMA Stream */ -+ HAL_DMA_Start_IT(hi2c->hdmatx, (uint32_t)hi2c->pBuffPtr, (uint32_t)&hi2c->Instance->DR, hi2c->XferSize); -+ -+ /* Enable Address Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ /* Enable EVT and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_ERR); -+ -+ /* Enable DMA Request */ -+ hi2c->Instance->CR2 |= I2C_CR2_DMAEN; -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Receive in slave mode an amount of data in non-blocking mode with DMA -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Slave_Receive_DMA(I2C_HandleTypeDef *hi2c, uint8_t *pData, uint16_t Size) -+{ -+ __IO uint32_t count = 0U; -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ if((pData == NULL) || (Size == 0U)) -+ { -+ return HAL_ERROR; -+ } -+ -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_RX; -+ hi2c->Mode = HAL_I2C_MODE_SLAVE; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ -+ /* Set the I2C DMA transfer complete callback */ -+ hi2c->hdmarx->XferCpltCallback = I2C_DMAXferCplt; -+ -+ /* Set the DMA error callback */ -+ hi2c->hdmarx->XferErrorCallback = I2C_DMAError; -+ -+ /* Set the unused DMA callbacks to NULL */ -+ hi2c->hdmarx->XferHalfCpltCallback = NULL; -+ hi2c->hdmarx->XferM1CpltCallback = NULL; -+ hi2c->hdmarx->XferM1HalfCpltCallback = NULL; -+ hi2c->hdmarx->XferAbortCallback = NULL; -+ -+ /* Enable the DMA Stream */ -+ HAL_DMA_Start_IT(hi2c->hdmarx, (uint32_t)&hi2c->Instance->DR, (uint32_t)hi2c->pBuffPtr, hi2c->XferSize); -+ -+ /* Enable Address Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ /* Enable EVT and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_ERR); -+ -+ /* Enable DMA Request */ -+ hi2c->Instance->CR2 |= I2C_CR2_DMAEN; -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+/** -+ * @brief Write an amount of data in blocking mode to a specific memory address -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address -+ * @param MemAddress Internal memory address -+ * @param MemAddSize Size of internal memory address -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @param Timeout Timeout duration -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Mem_Write(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint8_t *pData, uint16_t Size, uint32_t Timeout) -+{ -+ uint32_t tickstart = 0x00U; -+ -+ /* Init tickstart for timeout management*/ -+ tickstart = HAL_GetTick(); -+ -+ /* Check the parameters */ -+ assert_param(IS_I2C_MEMADD_SIZE(MemAddSize)); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Wait until BUSY flag is reset */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_BUSY, SET, I2C_TIMEOUT_BUSY_FLAG, tickstart) != HAL_OK) -+ { -+ return HAL_BUSY; -+ } -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_TX; -+ hi2c->Mode = HAL_I2C_MODE_MEM; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ -+ /* Send Slave Address and Memory Address */ -+ if(I2C_RequestMemoryWrite(hi2c, DevAddress, MemAddress, MemAddSize, Timeout, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_ERROR; -+ } -+ else -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ while(hi2c->XferSize > 0U) -+ { -+ /* Wait until TXE flag is set */ -+ if(I2C_WaitOnTXEFlagUntilTimeout(hi2c, Timeout, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Write data to DR */ -+ hi2c->Instance->DR = (*hi2c->pBuffPtr++); -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ -+ if((__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BTF) == SET) && (hi2c->XferSize != 0U)) -+ { -+ /* Write data to DR */ -+ hi2c->Instance->DR = (*hi2c->pBuffPtr++); -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ } -+ } -+ -+ /* Wait until BTF flag is set */ -+ if(I2C_WaitOnBTFFlagUntilTimeout(hi2c, Timeout, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Read an amount of data in blocking mode from a specific memory address -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address -+ * @param MemAddress Internal memory address -+ * @param MemAddSize Size of internal memory address -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @param Timeout Timeout duration -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Mem_Read(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint8_t *pData, uint16_t Size, uint32_t Timeout) -+{ -+ uint32_t tickstart = 0x00U; -+ -+ /* Init tickstart for timeout management*/ -+ tickstart = HAL_GetTick(); -+ -+ /* Check the parameters */ -+ assert_param(IS_I2C_MEMADD_SIZE(MemAddSize)); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Wait until BUSY flag is reset */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_BUSY, SET, I2C_TIMEOUT_BUSY_FLAG, tickstart) != HAL_OK) -+ { -+ return HAL_BUSY; -+ } -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_RX; -+ hi2c->Mode = HAL_I2C_MODE_MEM; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ -+ /* Send Slave Address and Memory Address */ -+ if(I2C_RequestMemoryRead(hi2c, DevAddress, MemAddress, MemAddSize, Timeout, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_ERROR; -+ } -+ else -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ if(hi2c->XferSize == 0U) -+ { -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ } -+ else if(hi2c->XferSize == 1U) -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ } -+ else if(hi2c->XferSize == 2U) -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Enable Pos */ -+ hi2c->Instance->CR1 |= I2C_CR1_POS; -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ } -+ else -+ { -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ } -+ -+ while(hi2c->XferSize > 0U) -+ { -+ if(hi2c->XferSize <= 3U) -+ { -+ /* One byte */ -+ if(hi2c->XferSize== 1U) -+ { -+ /* Wait until RXNE flag is set */ -+ if(I2C_WaitOnRXNEFlagUntilTimeout(hi2c, Timeout, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_TIMEOUT) -+ { -+ return HAL_TIMEOUT; -+ } -+ else -+ { -+ return HAL_ERROR; -+ } -+ } -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ } -+ /* Two bytes */ -+ else if(hi2c->XferSize == 2U) -+ { -+ /* Wait until BTF flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_BTF, RESET, Timeout, tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ } -+ /* 3 Last bytes */ -+ else -+ { -+ /* Wait until BTF flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_BTF, RESET, Timeout, tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ -+ /* Wait until BTF flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_BTF, RESET, Timeout, tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ } -+ } -+ else -+ { -+ /* Wait until RXNE flag is set */ -+ if(I2C_WaitOnRXNEFlagUntilTimeout(hi2c, Timeout, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_TIMEOUT) -+ { -+ return HAL_TIMEOUT; -+ } -+ else -+ { -+ return HAL_ERROR; -+ } -+ } -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ -+ if(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BTF) == SET) -+ { -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferSize--; -+ hi2c->XferCount--; -+ } -+ } -+ } -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Write an amount of data in non-blocking mode with Interrupt to a specific memory address -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address -+ * @param MemAddress Internal memory address -+ * @param MemAddSize Size of internal memory address -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Mem_Write_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint8_t *pData, uint16_t Size) -+{ -+ __IO uint32_t count = 0U; -+ -+ /* Check the parameters */ -+ assert_param(IS_I2C_MEMADD_SIZE(MemAddSize)); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_TX; -+ hi2c->Mode = HAL_I2C_MODE_MEM; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferSize = Size; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->Devaddress = DevAddress; -+ hi2c->Memaddress = MemAddress; -+ hi2c->MemaddSize = MemAddSize; -+ hi2c->EventCount = 0U; -+ -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ -+ /* Enable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Read an amount of data in non-blocking mode with Interrupt from a specific memory address -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address -+ * @param MemAddress Internal memory address -+ * @param MemAddSize Size of internal memory address -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Mem_Read_IT(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint8_t *pData, uint16_t Size) -+{ -+ __IO uint32_t count = 0U; -+ -+ /* Check the parameters */ -+ assert_param(IS_I2C_MEMADD_SIZE(MemAddSize)); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_RX; -+ hi2c->Mode = HAL_I2C_MODE_MEM; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferSize = Size; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->Devaddress = DevAddress; -+ hi2c->Memaddress = MemAddress; -+ hi2c->MemaddSize = MemAddSize; -+ hi2c->EventCount = 0U; -+ -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ if(hi2c->XferSize > 0U) -+ { -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ -+ /* Enable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ } -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Write an amount of data in non-blocking mode with DMA to a specific memory address -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address -+ * @param MemAddress Internal memory address -+ * @param MemAddSize Size of internal memory address -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be sent -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Mem_Write_DMA(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint8_t *pData, uint16_t Size) -+{ -+ __IO uint32_t count = 0U; -+ -+ uint32_t tickstart = 0x00U; -+ -+ /* Init tickstart for timeout management*/ -+ tickstart = HAL_GetTick(); -+ -+ /* Check the parameters */ -+ assert_param(IS_I2C_MEMADD_SIZE(MemAddSize)); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_TX; -+ hi2c->Mode = HAL_I2C_MODE_MEM; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferSize = Size; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ -+ if(hi2c->XferSize > 0U) -+ { -+ /* Set the I2C DMA transfer complete callback */ -+ hi2c->hdmatx->XferCpltCallback = I2C_DMAXferCplt; -+ -+ /* Set the DMA error callback */ -+ hi2c->hdmatx->XferErrorCallback = I2C_DMAError; -+ -+ /* Set the unused DMA callbacks to NULL */ -+ hi2c->hdmatx->XferHalfCpltCallback = NULL; -+ hi2c->hdmatx->XferM1CpltCallback = NULL; -+ hi2c->hdmatx->XferM1HalfCpltCallback = NULL; -+ hi2c->hdmatx->XferAbortCallback = NULL; -+ -+ /* Enable the DMA Stream */ -+ HAL_DMA_Start_IT(hi2c->hdmatx, (uint32_t)hi2c->pBuffPtr, (uint32_t)&hi2c->Instance->DR, hi2c->XferSize); -+ -+ /* Send Slave Address and Memory Address */ -+ if(I2C_RequestMemoryWrite(hi2c, DevAddress, MemAddress, MemAddSize, I2C_TIMEOUT_FLAG, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_ERROR; -+ } -+ else -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ /* Enable ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_ERR); -+ -+ /* Enable DMA Request */ -+ hi2c->Instance->CR2 |= I2C_CR2_DMAEN; -+ } -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Reads an amount of data in non-blocking mode with DMA from a specific memory address. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address -+ * @param MemAddress Internal memory address -+ * @param MemAddSize Size of internal memory address -+ * @param pData Pointer to data buffer -+ * @param Size Amount of data to be read -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_Mem_Read_DMA(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint8_t *pData, uint16_t Size) -+{ -+ uint32_t tickstart = 0x00U; -+ __IO uint32_t count = 0U; -+ -+ /* Init tickstart for timeout management*/ -+ tickstart = HAL_GetTick(); -+ -+ /* Check the parameters */ -+ assert_param(IS_I2C_MEMADD_SIZE(MemAddSize)); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Wait until BUSY flag is reset */ -+ count = I2C_TIMEOUT_BUSY_FLAG * (SystemCoreClock /25U /1000U); -+ do -+ { -+ if(count-- == 0U) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BUSY) != RESET); -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY_RX; -+ hi2c->Mode = HAL_I2C_MODE_MEM; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Prepare transfer parameters */ -+ hi2c->pBuffPtr = pData; -+ hi2c->XferCount = Size; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->XferSize = hi2c->XferCount; -+ -+ if(hi2c->XferSize > 0U) -+ { -+ /* Set the I2C DMA transfer complete callback */ -+ hi2c->hdmarx->XferCpltCallback = I2C_DMAXferCplt; -+ -+ /* Set the DMA error callback */ -+ hi2c->hdmarx->XferErrorCallback = I2C_DMAError; -+ -+ /* Set the unused DMA callbacks to NULL */ -+ hi2c->hdmarx->XferHalfCpltCallback = NULL; -+ hi2c->hdmarx->XferM1CpltCallback = NULL; -+ hi2c->hdmarx->XferM1HalfCpltCallback = NULL; -+ hi2c->hdmarx->XferAbortCallback = NULL; -+ -+ /* Enable the DMA Stream */ -+ HAL_DMA_Start_IT(hi2c->hdmarx, (uint32_t)&hi2c->Instance->DR, (uint32_t)hi2c->pBuffPtr, hi2c->XferSize); -+ -+ /* Send Slave Address and Memory Address */ -+ if(I2C_RequestMemoryRead(hi2c, DevAddress, MemAddress, MemAddSize, I2C_TIMEOUT_FLAG, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_ERROR; -+ } -+ else -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ if(Size == 1U) -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ } -+ else -+ { -+ /* Enable Last DMA bit */ -+ hi2c->Instance->CR2 |= I2C_CR2_LAST; -+ } -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ /* Note : The I2C interrupts must be enabled after unlocking current process -+ to avoid the risk of I2C interrupt handle execution before current -+ process unlock */ -+ /* Enable ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_ERR); -+ -+ /* Enable DMA Request */ -+ hi2c->Instance->CR2 |= I2C_CR2_DMAEN; -+ } -+ else -+ { -+ /* Send Slave Address and Memory Address */ -+ if(I2C_RequestMemoryRead(hi2c, DevAddress, MemAddress, MemAddSize, I2C_TIMEOUT_FLAG, tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_ERROR; -+ } -+ else -+ { -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ } -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Checks if target device is ready for communication. -+ * @note This function is used with Memory devices -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param DevAddress Target device address -+ * @param Trials Number of trials -+ * @param Timeout Timeout duration -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2C_IsDeviceReady(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint32_t Trials, uint32_t Timeout) -+{ -+ uint32_t tickstart = 0U, tmp1 = 0U, tmp2 = 0U, tmp3 = 0U, I2C_Trials = 1U; -+ -+ /* Get tick */ -+ tickstart = HAL_GetTick(); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ /* Wait until BUSY flag is reset */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_BUSY, SET, I2C_TIMEOUT_BUSY_FLAG, tickstart) != HAL_OK) -+ { -+ return HAL_BUSY; -+ } -+ -+ /* Process Locked */ -+ __HAL_LOCK(hi2c); -+ -+ /* Check if the I2C is already enabled */ -+ if((hi2c->Instance->CR1 & I2C_CR1_PE) != I2C_CR1_PE) -+ { -+ /* Enable I2C peripheral */ -+ __HAL_I2C_ENABLE(hi2c); -+ } -+ -+ /* Disable Pos */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ hi2c->State = HAL_I2C_STATE_BUSY; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ -+ do -+ { -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ /* Wait until SB flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_SB, RESET, Timeout, tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Send slave address */ -+ hi2c->Instance->DR = I2C_7BIT_ADD_WRITE(DevAddress); -+ -+ /* Wait until ADDR or AF flag are set */ -+ /* Get tick */ -+ tickstart = HAL_GetTick(); -+ -+ tmp1 = __HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_ADDR); -+ tmp2 = __HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_AF); -+ tmp3 = hi2c->State; -+ while((tmp1 == RESET) && (tmp2 == RESET) && (tmp3 != HAL_I2C_STATE_TIMEOUT)) -+ { -+ if((Timeout == 0U)||((HAL_GetTick() - tickstart ) > Timeout)) -+ { -+ hi2c->State = HAL_I2C_STATE_TIMEOUT; -+ } -+ tmp1 = __HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_ADDR); -+ tmp2 = __HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_AF); -+ tmp3 = hi2c->State; -+ } -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ -+ /* Check if the ADDR flag has been set */ -+ if(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_ADDR) == SET) -+ { -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ /* Clear ADDR Flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Wait until BUSY flag is reset */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_BUSY, SET, I2C_TIMEOUT_BUSY_FLAG, tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_OK; -+ } -+ else -+ { -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ /* Clear AF Flag */ -+ __HAL_I2C_CLEAR_FLAG(hi2c, I2C_FLAG_AF); -+ -+ /* Wait until BUSY flag is reset */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_BUSY, SET, I2C_TIMEOUT_BUSY_FLAG, tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ }while(I2C_Trials++ < Trials); -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief This function handles I2C event interrupt request. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval None -+ */ -+void HAL_I2C_EV_IRQHandler(I2C_HandleTypeDef *hi2c) -+{ -+ uint32_t sr2itflags = READ_REG(hi2c->Instance->SR2); -+ uint32_t sr1itflags = READ_REG(hi2c->Instance->SR1); -+ uint32_t itsources = READ_REG(hi2c->Instance->CR2); -+ -+ uint32_t CurrentMode = hi2c->Mode; -+ -+ /* Master or Memory mode selected */ -+ if((CurrentMode == HAL_I2C_MODE_MASTER) || (CurrentMode == HAL_I2C_MODE_MEM)) -+ { -+ /* SB Set ----------------------------------------------------------------*/ -+ if(((sr1itflags & I2C_FLAG_SB) != RESET) && ((itsources & I2C_IT_EVT) != RESET)) -+ { -+ I2C_Master_SB(hi2c); -+ } -+ /* ADD10 Set -------------------------------------------------------------*/ -+ else if(((sr1itflags & I2C_FLAG_ADD10) != RESET) && ((itsources & I2C_IT_EVT) != RESET)) -+ { -+ I2C_Master_ADD10(hi2c); -+ } -+ /* ADDR Set --------------------------------------------------------------*/ -+ else if(((sr1itflags & I2C_FLAG_ADDR) != RESET) && ((itsources & I2C_IT_EVT) != RESET)) -+ { -+ I2C_Master_ADDR(hi2c); -+ } -+ -+ /* I2C in mode Transmitter -----------------------------------------------*/ -+ if((sr2itflags & I2C_FLAG_TRA) != RESET) -+ { -+ /* TXE set and BTF reset -----------------------------------------------*/ -+ if(((sr1itflags & I2C_FLAG_TXE) != RESET) && ((itsources & I2C_IT_BUF) != RESET) && ((sr1itflags & I2C_FLAG_BTF) == RESET)) -+ { -+ I2C_MasterTransmit_TXE(hi2c); -+ } -+ /* BTF set -------------------------------------------------------------*/ -+ else if(((sr1itflags & I2C_FLAG_BTF) != RESET) && ((itsources & I2C_IT_EVT) != RESET)) -+ { -+ I2C_MasterTransmit_BTF(hi2c); -+ } -+ } -+ /* I2C in mode Receiver --------------------------------------------------*/ -+ else -+ { -+ /* RXNE set and BTF reset -----------------------------------------------*/ -+ if(((sr1itflags & I2C_FLAG_RXNE) != RESET) && ((itsources & I2C_IT_BUF) != RESET) && ((sr1itflags & I2C_FLAG_BTF) == RESET)) -+ { -+ I2C_MasterReceive_RXNE(hi2c); -+ } -+ /* BTF set -------------------------------------------------------------*/ -+ else if(((sr1itflags & I2C_FLAG_BTF) != RESET) && ((itsources & I2C_IT_EVT) != RESET)) -+ { -+ I2C_MasterReceive_BTF(hi2c); -+ } -+ } -+ } -+ /* Slave mode selected */ -+ else -+ { -+ /* ADDR set --------------------------------------------------------------*/ -+ if(((sr1itflags & I2C_FLAG_ADDR) != RESET) && ((itsources & I2C_IT_EVT) != RESET)) -+ { -+ I2C_Slave_ADDR(hi2c); -+ } -+ /* STOPF set --------------------------------------------------------------*/ -+ else if(((sr1itflags & I2C_FLAG_STOPF) != RESET) && ((itsources & I2C_IT_EVT) != RESET)) -+ { -+ I2C_Slave_STOPF(hi2c); -+ } -+ /* I2C in mode Transmitter -----------------------------------------------*/ -+ else if((sr2itflags & I2C_FLAG_TRA) != RESET) -+ { -+ /* TXE set and BTF reset -----------------------------------------------*/ -+ if(((sr1itflags & I2C_FLAG_TXE) != RESET) && ((itsources & I2C_IT_BUF) != RESET) && ((sr1itflags & I2C_FLAG_BTF) == RESET)) -+ { -+ I2C_SlaveTransmit_TXE(hi2c); -+ } -+ /* BTF set -------------------------------------------------------------*/ -+ else if(((sr1itflags & I2C_FLAG_BTF) != RESET) && ((itsources & I2C_IT_EVT) != RESET)) -+ { -+ I2C_SlaveTransmit_BTF(hi2c); -+ } -+ } -+ /* I2C in mode Receiver --------------------------------------------------*/ -+ else -+ { -+ /* RXNE set and BTF reset ----------------------------------------------*/ -+ if(((sr1itflags & I2C_FLAG_RXNE) != RESET) && ((itsources & I2C_IT_BUF) != RESET) && ((sr1itflags & I2C_FLAG_BTF) == RESET)) -+ { -+ I2C_SlaveReceive_RXNE(hi2c); -+ } -+ /* BTF set -------------------------------------------------------------*/ -+ else if(((sr1itflags & I2C_FLAG_BTF) != RESET) && ((itsources & I2C_IT_EVT) != RESET)) -+ { -+ I2C_SlaveReceive_BTF(hi2c); -+ } -+ } -+ } -+} -+ -+/** -+ * @brief This function handles I2C error interrupt request. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval None -+ */ -+void HAL_I2C_ER_IRQHandler(I2C_HandleTypeDef *hi2c) -+{ -+ uint32_t tmp1 = 0U, tmp2 = 0U, tmp3 = 0U, tmp4 = 0U; -+ uint32_t sr1itflags = READ_REG(hi2c->Instance->SR1); -+ uint32_t itsources = READ_REG(hi2c->Instance->CR2); -+ -+ /* I2C Bus error interrupt occurred ----------------------------------------*/ -+ if(((sr1itflags & I2C_FLAG_BERR) != RESET) && ((itsources & I2C_IT_ERR) != RESET)) -+ { -+ hi2c->ErrorCode |= HAL_I2C_ERROR_BERR; -+ -+ /* Clear BERR flag */ -+ __HAL_I2C_CLEAR_FLAG(hi2c, I2C_FLAG_BERR); -+ } -+ -+ /* I2C Arbitration Loss error interrupt occurred ---------------------------*/ -+ if(((sr1itflags & I2C_FLAG_ARLO) != RESET) && ((itsources & I2C_IT_ERR) != RESET)) -+ { -+ hi2c->ErrorCode |= HAL_I2C_ERROR_ARLO; -+ -+ /* Clear ARLO flag */ -+ __HAL_I2C_CLEAR_FLAG(hi2c, I2C_FLAG_ARLO); -+ } -+ -+ /* I2C Acknowledge failure error interrupt occurred ------------------------*/ -+ if(((sr1itflags & I2C_FLAG_AF) != RESET) && ((itsources & I2C_IT_ERR) != RESET)) -+ { -+ tmp1 = hi2c->Mode; -+ tmp2 = hi2c->XferCount; -+ tmp3 = hi2c->State; -+ tmp4 = hi2c->PreviousState; -+ if((tmp1 == HAL_I2C_MODE_SLAVE) && (tmp2 == 0U) && \ -+ ((tmp3 == HAL_I2C_STATE_BUSY_TX) || (tmp3 == HAL_I2C_STATE_BUSY_TX_LISTEN) || \ -+ ((tmp3 == HAL_I2C_STATE_LISTEN) && (tmp4 == I2C_STATE_SLAVE_BUSY_TX)))) -+ { -+ I2C_Slave_AF(hi2c); -+ } -+ else -+ { -+ hi2c->ErrorCode |= HAL_I2C_ERROR_AF; -+ -+ /* Do not generate a STOP in case of Slave receive non acknowledge during transfer (mean not at the end of transfer) */ -+ if(hi2c->Mode == HAL_I2C_MODE_MASTER) -+ { -+ /* Generate Stop */ -+ SET_BIT(hi2c->Instance->CR1,I2C_CR1_STOP); -+ } -+ -+ /* Clear AF flag */ -+ __HAL_I2C_CLEAR_FLAG(hi2c, I2C_FLAG_AF); -+ } -+ } -+ -+ /* I2C Over-Run/Under-Run interrupt occurred -------------------------------*/ -+ if(((sr1itflags & I2C_FLAG_OVR) != RESET) && ((itsources & I2C_IT_ERR) != RESET)) -+ { -+ hi2c->ErrorCode |= HAL_I2C_ERROR_OVR; -+ /* Clear OVR flag */ -+ __HAL_I2C_CLEAR_FLAG(hi2c, I2C_FLAG_OVR); -+ } -+ -+ /* Call the Error Callback in case of Error detected -----------------------*/ -+ if(hi2c->ErrorCode != HAL_I2C_ERROR_NONE) -+ { -+ I2C_ITError(hi2c); -+ } -+} -+ -+/** -+ * @brief Master Tx Transfer completed callback. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval None -+ */ -+__weak void HAL_I2C_MasterTxCpltCallback(I2C_HandleTypeDef *hi2c) -+{ -+ /* Prevent unused argument(s) compilation warning */ -+ UNUSED(hi2c); -+ -+ /* NOTE : This function should not be modified, when the callback is needed, -+ the HAL_I2C_MasterTxCpltCallback can be implemented in the user file -+ */ -+} -+ -+/** -+ * @brief Master Rx Transfer completed callback. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval None -+ */ -+__weak void HAL_I2C_MasterRxCpltCallback(I2C_HandleTypeDef *hi2c) -+{ -+ /* Prevent unused argument(s) compilation warning */ -+ UNUSED(hi2c); -+ -+ /* NOTE : This function should not be modified, when the callback is needed, -+ the HAL_I2C_MasterRxCpltCallback can be implemented in the user file -+ */ -+} -+ -+/** @brief Slave Tx Transfer completed callback. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval None -+ */ -+__weak void HAL_I2C_SlaveTxCpltCallback(I2C_HandleTypeDef *hi2c) -+{ -+ /* Prevent unused argument(s) compilation warning */ -+ UNUSED(hi2c); -+ -+ /* NOTE : This function should not be modified, when the callback is needed, -+ the HAL_I2C_SlaveTxCpltCallback can be implemented in the user file -+ */ -+} -+ -+/** -+ * @brief Slave Rx Transfer completed callback. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval None -+ */ -+__weak void HAL_I2C_SlaveRxCpltCallback(I2C_HandleTypeDef *hi2c) -+{ -+ /* Prevent unused argument(s) compilation warning */ -+ UNUSED(hi2c); -+ -+ /* NOTE : This function should not be modified, when the callback is needed, -+ the HAL_I2C_SlaveRxCpltCallback can be implemented in the user file -+ */ -+} -+ -+/** -+ * @brief Slave Address Match callback. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param TransferDirection Master request Transfer Direction (Write/Read), value of @ref I2C_XferOptions_definition -+ * @param AddrMatchCode Address Match Code -+ * @retval None -+ */ -+__weak void HAL_I2C_AddrCallback(I2C_HandleTypeDef *hi2c, uint8_t TransferDirection, uint16_t AddrMatchCode) -+{ -+ /* Prevent unused argument(s) compilation warning */ -+ UNUSED(hi2c); -+ UNUSED(TransferDirection); -+ UNUSED(AddrMatchCode); -+ -+ /* NOTE : This function should not be modified, when the callback is needed, -+ the HAL_I2C_AddrCallback can be implemented in the user file -+ */ -+} -+ -+/** -+ * @brief Listen Complete callback. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval None -+ */ -+__weak void HAL_I2C_ListenCpltCallback(I2C_HandleTypeDef *hi2c) -+{ -+ /* Prevent unused argument(s) compilation warning */ -+ UNUSED(hi2c); -+ -+ /* NOTE : This function should not be modified, when the callback is needed, -+ the HAL_I2C_ListenCpltCallback can be implemented in the user file -+ */ -+} -+ -+/** -+ * @brief Memory Tx Transfer completed callback. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval None -+ */ -+__weak void HAL_I2C_MemTxCpltCallback(I2C_HandleTypeDef *hi2c) -+{ -+ /* Prevent unused argument(s) compilation warning */ -+ UNUSED(hi2c); -+ -+ /* NOTE : This function should not be modified, when the callback is needed, -+ the HAL_I2C_MemTxCpltCallback can be implemented in the user file -+ */ -+} -+ -+/** -+ * @brief Memory Rx Transfer completed callback. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval None -+ */ -+__weak void HAL_I2C_MemRxCpltCallback(I2C_HandleTypeDef *hi2c) -+{ -+ /* Prevent unused argument(s) compilation warning */ -+ UNUSED(hi2c); -+ -+ /* NOTE : This function should not be modified, when the callback is needed, -+ the HAL_I2C_MemRxCpltCallback can be implemented in the user file -+ */ -+} -+ -+/** -+ * @brief I2C error callback. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval None -+ */ -+__weak void HAL_I2C_ErrorCallback(I2C_HandleTypeDef *hi2c) -+{ -+ /* Prevent unused argument(s) compilation warning */ -+ UNUSED(hi2c); -+ -+ /* NOTE : This function should not be modified, when the callback is needed, -+ the HAL_I2C_ErrorCallback can be implemented in the user file -+ */ -+} -+ -+/** -+ * @brief I2C abort callback. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval None -+ */ -+__weak void HAL_I2C_AbortCpltCallback(I2C_HandleTypeDef *hi2c) -+{ -+ /* Prevent unused argument(s) compilation warning */ -+ UNUSED(hi2c); -+ -+ /* NOTE : This function should not be modified, when the callback is needed, -+ the HAL_I2C_AbortCpltCallback could be implemented in the user file -+ */ -+} -+ -+/** -+ * @} -+ */ -+ -+/** @defgroup I2C_Exported_Functions_Group3 Peripheral State, Mode and Error functions -+ * @brief Peripheral State and Errors functions -+ * -+@verbatim -+ =============================================================================== -+ ##### Peripheral State, Mode and Error functions ##### -+ =============================================================================== -+ [..] -+ This subsection permits to get in run-time the status of the peripheral -+ and the data flow. -+ -+@endverbatim -+ * @{ -+ */ -+ -+/** -+ * @brief Return the I2C handle state. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval HAL state -+ */ -+HAL_I2C_StateTypeDef HAL_I2C_GetState(I2C_HandleTypeDef *hi2c) -+{ -+ /* Return I2C handle state */ -+ return hi2c->State; -+} -+ -+/** -+ * @brief Return the I2C Master, Slave, Memory or no mode. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL mode -+ */ -+HAL_I2C_ModeTypeDef HAL_I2C_GetMode(I2C_HandleTypeDef *hi2c) -+{ -+ return hi2c->Mode; -+} -+ -+/** -+ * @brief Return the I2C error code -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval I2C Error Code -+ */ -+uint32_t HAL_I2C_GetError(I2C_HandleTypeDef *hi2c) -+{ -+ return hi2c->ErrorCode; -+} -+ -+/** -+ * @} -+ */ -+ -+/** -+ * @brief Handle TXE flag for Master -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_MasterTransmit_TXE(I2C_HandleTypeDef *hi2c) -+{ -+ /* Declaration of temporary variables to prevent undefined behavior of volatile usage */ -+ uint32_t CurrentState = hi2c->State; -+ uint32_t CurrentMode = hi2c->Mode; -+ uint32_t CurrentXferOptions = hi2c->XferOptions; -+ -+ if((hi2c->XferSize == 0U) && (CurrentState == HAL_I2C_STATE_BUSY_TX)) -+ { -+ /* Call TxCpltCallback() directly if no stop mode is set */ -+ if((CurrentXferOptions != I2C_FIRST_AND_LAST_FRAME) && (CurrentXferOptions != I2C_LAST_FRAME) && (CurrentXferOptions != I2C_NO_OPTION_FRAME)) -+ { -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ hi2c->PreviousState = I2C_STATE_MASTER_BUSY_TX; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ hi2c->State = HAL_I2C_STATE_READY; -+ -+ HAL_I2C_MasterTxCpltCallback(hi2c); -+ } -+ else /* Generate Stop condition then Call TxCpltCallback() */ -+ { -+ /* Disable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State = HAL_I2C_STATE_READY; -+ -+ if(hi2c->Mode == HAL_I2C_MODE_MEM) -+ { -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ HAL_I2C_MemTxCpltCallback(hi2c); -+ } -+ else -+ { -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ HAL_I2C_MasterTxCpltCallback(hi2c); -+ } -+ } -+ } -+ else if((CurrentState == HAL_I2C_STATE_BUSY_TX) || \ -+ ((CurrentMode == HAL_I2C_MODE_MEM) && (CurrentState == HAL_I2C_STATE_BUSY_RX))) -+ { -+ if(hi2c->XferCount == 0U) -+ { -+ /* Disable BUF interrupt */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_BUF); -+ } -+ else -+ { -+ if(hi2c->Mode == HAL_I2C_MODE_MEM) -+ { -+ if(hi2c->EventCount == 0) -+ { -+ /* If Memory address size is 8Bit */ -+ if(hi2c->MemaddSize == I2C_MEMADD_SIZE_8BIT) -+ { -+ /* Send Memory Address */ -+ hi2c->Instance->DR = I2C_MEM_ADD_LSB(hi2c->Memaddress); -+ -+ hi2c->EventCount += 2; -+ } -+ /* If Memory address size is 16Bit */ -+ else -+ { -+ /* Send MSB of Memory Address */ -+ hi2c->Instance->DR = I2C_MEM_ADD_MSB(hi2c->Memaddress); -+ -+ hi2c->EventCount++; -+ } -+ } -+ else if(hi2c->EventCount == 1) -+ { -+ /* Send LSB of Memory Address */ -+ hi2c->Instance->DR = I2C_MEM_ADD_LSB(hi2c->Memaddress); -+ -+ hi2c->EventCount++; -+ } -+ else if(hi2c->EventCount == 2) -+ { -+ if(hi2c->State == HAL_I2C_STATE_BUSY_RX) -+ { -+ /* Generate Restart */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ } -+ else if(hi2c->State == HAL_I2C_STATE_BUSY_TX) -+ { -+ /* Write data to DR */ -+ hi2c->Instance->DR = (*hi2c->pBuffPtr++); -+ hi2c->XferCount--; -+ } -+ } -+ } -+ else -+ { -+ /* Write data to DR */ -+ hi2c->Instance->DR = (*hi2c->pBuffPtr++); -+ hi2c->XferCount--; -+ } -+ } -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @brief Handle BTF flag for Master transmitter -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_MasterTransmit_BTF(I2C_HandleTypeDef *hi2c) -+{ -+ /* Declaration of temporary variables to prevent undefined behavior of volatile usage */ -+ uint32_t CurrentXferOptions = hi2c->XferOptions; -+ -+ if(hi2c->State == HAL_I2C_STATE_BUSY_TX) -+ { -+ if(hi2c->XferCount != 0U) -+ { -+ /* Write data to DR */ -+ hi2c->Instance->DR = (*hi2c->pBuffPtr++); -+ hi2c->XferCount--; -+ } -+ else -+ { -+ /* Call TxCpltCallback() directly if no stop mode is set */ -+ if((CurrentXferOptions != I2C_FIRST_AND_LAST_FRAME) && (CurrentXferOptions != I2C_LAST_FRAME) && (CurrentXferOptions != I2C_NO_OPTION_FRAME)) -+ { -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ hi2c->PreviousState = I2C_STATE_MASTER_BUSY_TX; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ hi2c->State = HAL_I2C_STATE_READY; -+ -+ HAL_I2C_MasterTxCpltCallback(hi2c); -+ } -+ else /* Generate Stop condition then Call TxCpltCallback() */ -+ { -+ /* Disable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State = HAL_I2C_STATE_READY; -+ -+ if(hi2c->Mode == HAL_I2C_MODE_MEM) -+ { -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ HAL_I2C_MemTxCpltCallback(hi2c); -+ } -+ else -+ { -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ HAL_I2C_MasterTxCpltCallback(hi2c); -+ } -+ } -+ } -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @brief Handle RXNE flag for Master -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_MasterReceive_RXNE(I2C_HandleTypeDef *hi2c) -+{ -+ if(hi2c->State == HAL_I2C_STATE_BUSY_RX) -+ { -+ uint32_t tmp = 0U; -+ -+ tmp = hi2c->XferCount; -+ if(tmp > 3U) -+ { -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferCount--; -+ -+ if(hi2c->XferCount == 3) -+ { -+ /* Disable BUF interrupt, this help to treat correctly the last 4 bytes -+ on BTF subroutine */ -+ /* Disable BUF interrupt */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_BUF); -+ } -+ } -+ else if((tmp == 1U) || (tmp == 0U)) -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Disable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferCount--; -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->PreviousState = I2C_STATE_NONE; -+ -+ if(hi2c->Mode == HAL_I2C_MODE_MEM) -+ { -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ HAL_I2C_MemRxCpltCallback(hi2c); -+ } -+ else -+ { -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ HAL_I2C_MasterRxCpltCallback(hi2c); -+ } -+ } -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @brief Handle BTF flag for Master receiver -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_MasterReceive_BTF(I2C_HandleTypeDef *hi2c) -+{ -+ /* Declaration of temporary variables to prevent undefined behavior of volatile usage */ -+ uint32_t CurrentXferOptions = hi2c->XferOptions; -+ -+ if(hi2c->XferCount == 4U) -+ { -+ /* Disable BUF interrupt, this help to treat correctly the last 2 bytes -+ on BTF subroutine if there is a reception delay between N-1 and N byte */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_BUF); -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferCount--; -+ } -+ else if(hi2c->XferCount == 3U) -+ { -+ /* Disable BUF interrupt, this help to treat correctly the last 2 bytes -+ on BTF subroutine if there is a reception delay between N-1 and N byte */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_BUF); -+ -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferCount--; -+ } -+ else if(hi2c->XferCount == 2U) -+ { -+ /* Prepare next transfer or stop current transfer */ -+ if((CurrentXferOptions == I2C_NEXT_FRAME) || (CurrentXferOptions == I2C_FIRST_FRAME)) -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Generate ReStart */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ } -+ else -+ { -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ } -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferCount--; -+ -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferCount--; -+ -+ /* Disable EVT and ERR interrupt */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_ERR); -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->PreviousState = I2C_STATE_NONE; -+ -+ if(hi2c->Mode == HAL_I2C_MODE_MEM) -+ { -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ HAL_I2C_MemRxCpltCallback(hi2c); -+ } -+ else -+ { -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ HAL_I2C_MasterRxCpltCallback(hi2c); -+ } -+ } -+ else -+ { -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferCount--; -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @brief Handle SB flag for Master -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_Master_SB(I2C_HandleTypeDef *hi2c) -+{ -+ if(hi2c->Mode == HAL_I2C_MODE_MEM) -+ { -+ if(hi2c->EventCount == 0U) -+ { -+ /* Send slave address */ -+ hi2c->Instance->DR = I2C_7BIT_ADD_WRITE(hi2c->Devaddress); -+ } -+ else -+ { -+ hi2c->Instance->DR = I2C_7BIT_ADD_READ(hi2c->Devaddress); -+ } -+ } -+ else -+ { -+ if(hi2c->Init.AddressingMode == I2C_ADDRESSINGMODE_7BIT) -+ { -+ /* Send slave 7 Bits address */ -+ if(hi2c->State == HAL_I2C_STATE_BUSY_TX) -+ { -+ hi2c->Instance->DR = I2C_7BIT_ADD_WRITE(hi2c->Devaddress); -+ } -+ else -+ { -+ hi2c->Instance->DR = I2C_7BIT_ADD_READ(hi2c->Devaddress); -+ } -+ } -+ else -+ { -+ if(hi2c->EventCount == 0U) -+ { -+ /* Send header of slave address */ -+ hi2c->Instance->DR = I2C_10BIT_HEADER_WRITE(hi2c->Devaddress); -+ } -+ else if(hi2c->EventCount == 1U) -+ { -+ /* Send header of slave address */ -+ hi2c->Instance->DR = I2C_10BIT_HEADER_READ(hi2c->Devaddress); -+ } -+ } -+ } -+ -+ return HAL_OK; -+} -+ -+/** -+ * @brief Handle ADD10 flag for Master -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_Master_ADD10(I2C_HandleTypeDef *hi2c) -+{ -+ /* Send slave address */ -+ hi2c->Instance->DR = I2C_10BIT_ADDRESS(hi2c->Devaddress); -+ -+ return HAL_OK; -+} -+ -+/** -+ * @brief Handle ADDR flag for Master -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_Master_ADDR(I2C_HandleTypeDef *hi2c) -+{ -+ /* Declaration of temporary variable to prevent undefined behavior of volatile usage */ -+ uint32_t CurrentMode = hi2c->Mode; -+ uint32_t CurrentXferOptions = hi2c->XferOptions; -+ uint32_t Prev_State = hi2c->PreviousState; -+ -+ if(hi2c->State == HAL_I2C_STATE_BUSY_RX) -+ { -+ if((hi2c->EventCount == 0U) && (CurrentMode == HAL_I2C_MODE_MEM)) -+ { -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ } -+ else if((hi2c->EventCount == 0U) && (hi2c->Init.AddressingMode == I2C_ADDRESSINGMODE_10BIT)) -+ { -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Generate Restart */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ hi2c->EventCount++; -+ } -+ else -+ { -+ if(hi2c->XferCount == 0U) -+ { -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ } -+ else if(hi2c->XferCount == 1U) -+ { -+ if(CurrentXferOptions == I2C_NO_OPTION_FRAME) -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ if((hi2c->Instance->CR2 & I2C_CR2_DMAEN) == I2C_CR2_DMAEN) -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ } -+ else -+ { -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ } -+ } -+ /* Prepare next transfer or stop current transfer */ -+ else if((CurrentXferOptions != I2C_FIRST_AND_LAST_FRAME) && (CurrentXferOptions != I2C_LAST_FRAME) \ -+ && (Prev_State != I2C_STATE_MASTER_BUSY_RX)) -+ { -+ if(hi2c->XferOptions != I2C_NEXT_FRAME) -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ } -+ else -+ { -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ } -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ } -+ else -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ } -+ } -+ else if(hi2c->XferCount == 2U) -+ { -+ if(hi2c->XferOptions != I2C_NEXT_FRAME) -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Enable Pos */ -+ hi2c->Instance->CR1 |= I2C_CR1_POS; -+ } -+ else -+ { -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ } -+ -+ if((hi2c->Instance->CR2 & I2C_CR2_DMAEN) == I2C_CR2_DMAEN) -+ { -+ /* Enable Last DMA bit */ -+ hi2c->Instance->CR2 |= I2C_CR2_LAST; -+ } -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ } -+ else -+ { -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ if((hi2c->Instance->CR2 & I2C_CR2_DMAEN) == I2C_CR2_DMAEN) -+ { -+ /* Enable Last DMA bit */ -+ hi2c->Instance->CR2 |= I2C_CR2_LAST; -+ } -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ } -+ -+ /* Reset Event counter */ -+ hi2c->EventCount = 0U; -+ } -+ } -+ else -+ { -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ } -+ -+ return HAL_OK; -+} -+ -+/** -+ * @brief Handle TXE flag for Slave -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_SlaveTransmit_TXE(I2C_HandleTypeDef *hi2c) -+{ -+ /* Declaration of temporary variables to prevent undefined behavior of volatile usage */ -+ uint32_t CurrentState = hi2c->State; -+ -+ if(hi2c->XferCount != 0U) -+ { -+ /* Write data to DR */ -+ hi2c->Instance->DR = (*hi2c->pBuffPtr++); -+ hi2c->XferCount--; -+ -+ if((hi2c->XferCount == 0U) && (CurrentState == HAL_I2C_STATE_BUSY_TX_LISTEN)) -+ { -+ /* Last Byte is received, disable Interrupt */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_BUF); -+ -+ /* Set state at HAL_I2C_STATE_LISTEN */ -+ hi2c->PreviousState = I2C_STATE_SLAVE_BUSY_TX; -+ hi2c->State = HAL_I2C_STATE_LISTEN; -+ -+ /* Call the Tx complete callback to inform upper layer of the end of receive process */ -+ HAL_I2C_SlaveTxCpltCallback(hi2c); -+ } -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @brief Handle BTF flag for Slave transmitter -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_SlaveTransmit_BTF(I2C_HandleTypeDef *hi2c) -+{ -+ if(hi2c->XferCount != 0U) -+ { -+ /* Write data to DR */ -+ hi2c->Instance->DR = (*hi2c->pBuffPtr++); -+ hi2c->XferCount--; -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @brief Handle RXNE flag for Slave -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_SlaveReceive_RXNE(I2C_HandleTypeDef *hi2c) -+{ -+ /* Declaration of temporary variables to prevent undefined behavior of volatile usage */ -+ uint32_t CurrentState = hi2c->State; -+ -+ if(hi2c->XferCount != 0U) -+ { -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferCount--; -+ -+ if((hi2c->XferCount == 0U) && (CurrentState == HAL_I2C_STATE_BUSY_RX_LISTEN)) -+ { -+ /* Last Byte is received, disable Interrupt */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_BUF); -+ -+ /* Set state at HAL_I2C_STATE_LISTEN */ -+ hi2c->PreviousState = I2C_STATE_SLAVE_BUSY_RX; -+ hi2c->State = HAL_I2C_STATE_LISTEN; -+ -+ /* Call the Rx complete callback to inform upper layer of the end of receive process */ -+ HAL_I2C_SlaveRxCpltCallback(hi2c); -+ } -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @brief Handle BTF flag for Slave receiver -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_SlaveReceive_BTF(I2C_HandleTypeDef *hi2c) -+{ -+ if(hi2c->XferCount != 0U) -+ { -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferCount--; -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @brief Handle ADD flag for Slave -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_Slave_ADDR(I2C_HandleTypeDef *hi2c) -+{ -+ uint8_t TransferDirection = I2C_DIRECTION_RECEIVE; -+ uint16_t SlaveAddrCode = 0U; -+ -+ /* Transfer Direction requested by Master */ -+ if(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_TRA) == RESET) -+ { -+ TransferDirection = I2C_DIRECTION_TRANSMIT; -+ } -+ -+ if(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_DUALF) == RESET) -+ { -+ SlaveAddrCode = hi2c->Init.OwnAddress1; -+ } -+ else -+ { -+ SlaveAddrCode = hi2c->Init.OwnAddress2; -+ } -+ -+ /* Call Slave Addr callback */ -+ HAL_I2C_AddrCallback(hi2c, TransferDirection, SlaveAddrCode); -+ -+ return HAL_OK; -+} -+ -+/** -+ * @brief Handle STOPF flag for Slave -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_Slave_STOPF(I2C_HandleTypeDef *hi2c) -+{ -+ /* Declaration of temporary variable to prevent undefined behavior of volatile usage */ -+ uint32_t CurrentState = hi2c->State; -+ -+ /* Disable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ /* Clear STOPF flag */ -+ __HAL_I2C_CLEAR_STOPFLAG(hi2c); -+ -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* If a DMA is ongoing, Update handle size context */ -+ if((hi2c->Instance->CR2 & I2C_CR2_DMAEN) == I2C_CR2_DMAEN) -+ { -+ if((hi2c->State == HAL_I2C_STATE_BUSY_RX) || (hi2c->State == HAL_I2C_STATE_BUSY_RX_LISTEN)) -+ { -+ hi2c->XferCount = __HAL_DMA_GET_COUNTER(hi2c->hdmarx); -+ } -+ else -+ { -+ hi2c->XferCount = __HAL_DMA_GET_COUNTER(hi2c->hdmatx); -+ } -+ } -+ -+ /* All data are not transferred, so set error code accordingly */ -+ if(hi2c->XferCount != 0U) -+ { -+ /* Store Last receive data if any */ -+ if(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BTF) == SET) -+ { -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferCount--; -+ } -+ -+ /* Store Last receive data if any */ -+ if(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_RXNE) == SET) -+ { -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ hi2c->XferCount--; -+ } -+ -+ /* Set ErrorCode corresponding to a Non-Acknowledge */ -+ //hi2c->ErrorCode |= HAL_I2C_ERROR_AF; -+ } -+ -+ if(hi2c->ErrorCode != HAL_I2C_ERROR_NONE) -+ { -+ /* Call the corresponding callback to inform upper layer of End of Transfer */ -+ I2C_ITError(hi2c); -+ } -+ else -+ { -+ if((CurrentState == HAL_I2C_STATE_LISTEN ) || (CurrentState == HAL_I2C_STATE_BUSY_RX_LISTEN) || \ -+ (CurrentState == HAL_I2C_STATE_BUSY_TX_LISTEN)) -+ { -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Call the Listen Complete callback, to inform upper layer of the end of Listen usecase */ -+ HAL_I2C_ListenCpltCallback(hi2c); -+ } -+ else -+ { -+ if((hi2c->PreviousState == I2C_STATE_SLAVE_BUSY_RX) || (CurrentState == HAL_I2C_STATE_BUSY_RX)) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ HAL_I2C_SlaveRxCpltCallback(hi2c); -+ } -+ } -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_Slave_AF(I2C_HandleTypeDef *hi2c) -+{ -+ /* Declaration of temporary variables to prevent undefined behavior of volatile usage */ -+ uint32_t CurrentState = hi2c->State; -+ uint32_t CurrentXferOptions = hi2c->XferOptions; -+ -+ if(((CurrentXferOptions == I2C_FIRST_AND_LAST_FRAME) || (CurrentXferOptions == I2C_LAST_FRAME)) && \ -+ (CurrentState == HAL_I2C_STATE_LISTEN)) -+ { -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ -+ /* Disable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ /* Clear AF flag */ -+ __HAL_I2C_CLEAR_FLAG(hi2c, I2C_FLAG_AF); -+ -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Call the Listen Complete callback, to inform upper layer of the end of Listen usecase */ -+ HAL_I2C_ListenCpltCallback(hi2c); -+ } -+ else if(CurrentState == HAL_I2C_STATE_BUSY_TX) -+ { -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->PreviousState = I2C_STATE_SLAVE_BUSY_TX; -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Disable EVT, BUF and ERR interrupt */ -+ __HAL_I2C_DISABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_BUF | I2C_IT_ERR); -+ -+ /* Clear AF flag */ -+ __HAL_I2C_CLEAR_FLAG(hi2c, I2C_FLAG_AF); -+ -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ HAL_I2C_SlaveTxCpltCallback(hi2c); -+ } -+ else -+ { -+ /* Clear AF flag only */ -+ /* State Listen, but XferOptions == FIRST or NEXT */ -+ __HAL_I2C_CLEAR_FLAG(hi2c, I2C_FLAG_AF); -+ } -+ -+ return HAL_OK; -+} -+ -+/** -+ * @brief I2C interrupts error process -+ * @param hi2c I2C handle. -+ * @retval None -+ */ -+static void I2C_ITError(I2C_HandleTypeDef *hi2c) -+{ -+ /* Declaration of temporary variable to prevent undefined behavior of volatile usage */ -+ uint32_t CurrentState = hi2c->State; -+ -+ if((CurrentState == HAL_I2C_STATE_BUSY_TX_LISTEN) || (CurrentState == HAL_I2C_STATE_BUSY_RX_LISTEN)) -+ { -+ /* keep HAL_I2C_STATE_LISTEN */ -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State = HAL_I2C_STATE_LISTEN; -+ } -+ else -+ { -+ /* If state is an abort treatment on going, don't change state */ -+ /* This change will be do later */ -+ if((hi2c->State != HAL_I2C_STATE_ABORT) && ((hi2c->Instance->CR2 & I2C_CR2_DMAEN) != I2C_CR2_DMAEN)) -+ { -+ hi2c->State = HAL_I2C_STATE_READY; -+ } -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ } -+ -+ /* Disable Pos bit in I2C CR1 when error occurred in Master/Mem Receive IT Process */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_POS; -+ -+ /* Abort DMA transfer */ -+ if((hi2c->Instance->CR2 & I2C_CR2_DMAEN) == I2C_CR2_DMAEN) -+ { -+ hi2c->Instance->CR2 &= ~I2C_CR2_DMAEN; -+ -+ if(hi2c->hdmatx->State != HAL_DMA_STATE_READY) -+ { -+ /* Set the DMA Abort callback : -+ will lead to call HAL_I2C_ErrorCallback() at end of DMA abort procedure */ -+ hi2c->hdmatx->XferAbortCallback = I2C_DMAAbort; -+ -+ if(HAL_DMA_Abort_IT(hi2c->hdmatx) != HAL_OK) -+ { -+ /* Disable I2C peripheral to prevent dummy data in buffer */ -+ __HAL_I2C_DISABLE(hi2c); -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ -+ /* Call Directly XferAbortCallback function in case of error */ -+ hi2c->hdmatx->XferAbortCallback(hi2c->hdmatx); -+ } -+ } -+ else -+ { -+ /* Set the DMA Abort callback : -+ will lead to call HAL_I2C_ErrorCallback() at end of DMA abort procedure */ -+ hi2c->hdmarx->XferAbortCallback = I2C_DMAAbort; -+ -+ if(HAL_DMA_Abort_IT(hi2c->hdmarx) != HAL_OK) -+ { -+ /* Store Last receive data if any */ -+ if(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_RXNE) == SET) -+ { -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ } -+ -+ /* Disable I2C peripheral to prevent dummy data in buffer */ -+ __HAL_I2C_DISABLE(hi2c); -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ -+ /* Call Directly hi2c->hdmarx->XferAbortCallback function in case of error */ -+ hi2c->hdmarx->XferAbortCallback(hi2c->hdmarx); -+ } -+ } -+ } -+ else if(hi2c->State == HAL_I2C_STATE_ABORT) -+ { -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Store Last receive data if any */ -+ if(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_RXNE) == SET) -+ { -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ } -+ -+ /* Disable I2C peripheral to prevent dummy data in buffer */ -+ __HAL_I2C_DISABLE(hi2c); -+ -+ /* Call the corresponding callback to inform upper layer of End of Transfer */ -+ HAL_I2C_AbortCpltCallback(hi2c); -+ } -+ else -+ { -+ /* Store Last receive data if any */ -+ if(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_RXNE) == SET) -+ { -+ /* Read data from DR */ -+ (*hi2c->pBuffPtr++) = hi2c->Instance->DR; -+ } -+ -+ /* Call user error callback */ -+ HAL_I2C_ErrorCallback(hi2c); -+ } -+ /* STOP Flag is not set after a NACK reception */ -+ /* So may inform upper layer that listen phase is stopped */ -+ /* during NACK error treatment */ -+ if((hi2c->State == HAL_I2C_STATE_LISTEN) && ((hi2c->ErrorCode & HAL_I2C_ERROR_AF) == HAL_I2C_ERROR_AF)) -+ { -+ hi2c->XferOptions = I2C_NO_OPTION_FRAME; -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Call the Listen Complete callback, to inform upper layer of the end of Listen usecase */ -+ HAL_I2C_ListenCpltCallback(hi2c); -+ } -+} -+ -+/** -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @param DevAddress Target device address The device 7 bits address value -+ * in datasheet must be shifted to the left before calling the interface -+ * @param Timeout Timeout duration -+ * @param Tickstart Tick start value -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_MasterRequestWrite(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint32_t Timeout, uint32_t Tickstart) -+{ -+ /* Declaration of temporary variable to prevent undefined behavior of volatile usage */ -+ uint32_t CurrentXferOptions = hi2c->XferOptions; -+ -+ /* Generate Start condition if first transfer */ -+ if((CurrentXferOptions == I2C_FIRST_AND_LAST_FRAME) || (CurrentXferOptions == I2C_FIRST_FRAME) || (CurrentXferOptions == I2C_NO_OPTION_FRAME)) -+ { -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ } -+ else if(hi2c->PreviousState == I2C_STATE_MASTER_BUSY_RX) -+ { -+ /* Generate ReStart */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ } -+ -+ /* Wait until SB flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_SB, RESET, Timeout, Tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ if(hi2c->Init.AddressingMode == I2C_ADDRESSINGMODE_7BIT) -+ { -+ /* Send slave address */ -+ hi2c->Instance->DR = I2C_7BIT_ADD_WRITE(DevAddress); -+ } -+ else -+ { -+ /* Send header of slave address */ -+ hi2c->Instance->DR = I2C_10BIT_HEADER_WRITE(DevAddress); -+ -+ /* Wait until ADD10 flag is set */ -+ if(I2C_WaitOnMasterAddressFlagUntilTimeout(hi2c, I2C_FLAG_ADD10, Timeout, Tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Send slave address */ -+ hi2c->Instance->DR = I2C_10BIT_ADDRESS(DevAddress); -+ } -+ -+ /* Wait until ADDR flag is set */ -+ if(I2C_WaitOnMasterAddressFlagUntilTimeout(hi2c, I2C_FLAG_ADDR, Timeout, Tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ return HAL_OK; -+} -+ -+/** -+ * @brief Master sends target device address for read request. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @param DevAddress Target device address The device 7 bits address value -+ * in datasheet must be shifted to the left before calling the interface -+ * @param Timeout Timeout duration -+ * @param Tickstart Tick start value -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_MasterRequestRead(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint32_t Timeout, uint32_t Tickstart) -+{ -+ /* Declaration of temporary variable to prevent undefined behavior of volatile usage */ -+ uint32_t CurrentXferOptions = hi2c->XferOptions; -+ -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Generate Start condition if first transfer */ -+ if((CurrentXferOptions == I2C_FIRST_AND_LAST_FRAME) || (CurrentXferOptions == I2C_FIRST_FRAME) || (CurrentXferOptions == I2C_NO_OPTION_FRAME)) -+ { -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ } -+ else if(hi2c->PreviousState == I2C_STATE_MASTER_BUSY_TX) -+ { -+ /* Generate ReStart */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ } -+ -+ /* Wait until SB flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_SB, RESET, Timeout, Tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ if(hi2c->Init.AddressingMode == I2C_ADDRESSINGMODE_7BIT) -+ { -+ /* Send slave address */ -+ hi2c->Instance->DR = I2C_7BIT_ADD_READ(DevAddress); -+ } -+ else -+ { -+ /* Send header of slave address */ -+ hi2c->Instance->DR = I2C_10BIT_HEADER_WRITE(DevAddress); -+ -+ /* Wait until ADD10 flag is set */ -+ if(I2C_WaitOnMasterAddressFlagUntilTimeout(hi2c, I2C_FLAG_ADD10, Timeout, Tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Send slave address */ -+ hi2c->Instance->DR = I2C_10BIT_ADDRESS(DevAddress); -+ -+ /* Wait until ADDR flag is set */ -+ if(I2C_WaitOnMasterAddressFlagUntilTimeout(hi2c, I2C_FLAG_ADDR, Timeout, Tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Generate Restart */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ /* Wait until SB flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_SB, RESET, Timeout, Tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Send header of slave address */ -+ hi2c->Instance->DR = I2C_10BIT_HEADER_READ(DevAddress); -+ } -+ -+ /* Wait until ADDR flag is set */ -+ if(I2C_WaitOnMasterAddressFlagUntilTimeout(hi2c, I2C_FLAG_ADDR, Timeout, Tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ return HAL_OK; -+} -+ -+/** -+ * @brief Master sends target device address followed by internal memory address for write request. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @param DevAddress Target device address -+ * @param MemAddress Internal memory address -+ * @param MemAddSize Size of internal memory address -+ * @param Timeout Timeout duration -+ * @param Tickstart Tick start value -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_RequestMemoryWrite(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint32_t Timeout, uint32_t Tickstart) -+{ -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ /* Wait until SB flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_SB, RESET, Timeout, Tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Send slave address */ -+ hi2c->Instance->DR = I2C_7BIT_ADD_WRITE(DevAddress); -+ -+ /* Wait until ADDR flag is set */ -+ if(I2C_WaitOnMasterAddressFlagUntilTimeout(hi2c, I2C_FLAG_ADDR, Timeout, Tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Wait until TXE flag is set */ -+ if(I2C_WaitOnTXEFlagUntilTimeout(hi2c, Timeout, Tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* If Memory address size is 8Bit */ -+ if(MemAddSize == I2C_MEMADD_SIZE_8BIT) -+ { -+ /* Send Memory Address */ -+ hi2c->Instance->DR = I2C_MEM_ADD_LSB(MemAddress); -+ } -+ /* If Memory address size is 16Bit */ -+ else -+ { -+ /* Send MSB of Memory Address */ -+ hi2c->Instance->DR = I2C_MEM_ADD_MSB(MemAddress); -+ -+ /* Wait until TXE flag is set */ -+ if(I2C_WaitOnTXEFlagUntilTimeout(hi2c, Timeout, Tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Send LSB of Memory Address */ -+ hi2c->Instance->DR = I2C_MEM_ADD_LSB(MemAddress); -+ } -+ -+ return HAL_OK; -+} -+ -+/** -+ * @brief Master sends target device address followed by internal memory address for read request. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @param DevAddress Target device address -+ * @param MemAddress Internal memory address -+ * @param MemAddSize Size of internal memory address -+ * @param Timeout Timeout duration -+ * @param Tickstart Tick start value -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_RequestMemoryRead(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress, uint16_t MemAddSize, uint32_t Timeout, uint32_t Tickstart) -+{ -+ /* Enable Acknowledge */ -+ hi2c->Instance->CR1 |= I2C_CR1_ACK; -+ -+ /* Generate Start */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ /* Wait until SB flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_SB, RESET, Timeout, Tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Send slave address */ -+ hi2c->Instance->DR = I2C_7BIT_ADD_WRITE(DevAddress); -+ -+ /* Wait until ADDR flag is set */ -+ if(I2C_WaitOnMasterAddressFlagUntilTimeout(hi2c, I2C_FLAG_ADDR, Timeout, Tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Clear ADDR flag */ -+ __HAL_I2C_CLEAR_ADDRFLAG(hi2c); -+ -+ /* Wait until TXE flag is set */ -+ if(I2C_WaitOnTXEFlagUntilTimeout(hi2c, Timeout, Tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* If Memory address size is 8Bit */ -+ if(MemAddSize == I2C_MEMADD_SIZE_8BIT) -+ { -+ /* Send Memory Address */ -+ hi2c->Instance->DR = I2C_MEM_ADD_LSB(MemAddress); -+ } -+ /* If Memory address size is 16Bit */ -+ else -+ { -+ /* Send MSB of Memory Address */ -+ hi2c->Instance->DR = I2C_MEM_ADD_MSB(MemAddress); -+ -+ /* Wait until TXE flag is set */ -+ if(I2C_WaitOnTXEFlagUntilTimeout(hi2c, Timeout, Tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Send LSB of Memory Address */ -+ hi2c->Instance->DR = I2C_MEM_ADD_LSB(MemAddress); -+ } -+ -+ /* Wait until TXE flag is set */ -+ if(I2C_WaitOnTXEFlagUntilTimeout(hi2c, Timeout, Tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ /* Generate Restart */ -+ hi2c->Instance->CR1 |= I2C_CR1_START; -+ -+ /* Wait until SB flag is set */ -+ if(I2C_WaitOnFlagUntilTimeout(hi2c, I2C_FLAG_SB, RESET, Timeout, Tickstart) != HAL_OK) -+ { -+ return HAL_TIMEOUT; -+ } -+ -+ /* Send slave address */ -+ hi2c->Instance->DR = I2C_7BIT_ADD_READ(DevAddress); -+ -+ /* Wait until ADDR flag is set */ -+ if(I2C_WaitOnMasterAddressFlagUntilTimeout(hi2c, I2C_FLAG_ADDR, Timeout, Tickstart) != HAL_OK) -+ { -+ if(hi2c->ErrorCode == HAL_I2C_ERROR_AF) -+ { -+ return HAL_ERROR; -+ } -+ else -+ { -+ return HAL_TIMEOUT; -+ } -+ } -+ -+ return HAL_OK; -+} -+ -+/** -+ * @brief DMA I2C process complete callback. -+ * @param hdma DMA handle -+ * @retval None -+ */ -+static void I2C_DMAXferCplt(DMA_HandleTypeDef *hdma) -+{ -+ I2C_HandleTypeDef* hi2c = (I2C_HandleTypeDef*)((DMA_HandleTypeDef*)hdma)->Parent; -+ -+ /* Declaration of temporary variable to prevent undefined behavior of volatile usage */ -+ uint32_t CurrentState = hi2c->State; -+ uint32_t CurrentMode = hi2c->Mode; -+ -+ if((CurrentState == HAL_I2C_STATE_BUSY_TX) || ((CurrentState == HAL_I2C_STATE_BUSY_RX) && (CurrentMode == HAL_I2C_MODE_SLAVE))) -+ { -+ /* Disable DMA Request */ -+ hi2c->Instance->CR2 &= ~I2C_CR2_DMAEN; -+ -+ hi2c->XferCount = 0U; -+ -+ /* Enable EVT and ERR interrupt */ -+ __HAL_I2C_ENABLE_IT(hi2c, I2C_IT_EVT | I2C_IT_ERR); -+ } -+ else -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ /* Disable Last DMA */ -+ hi2c->Instance->CR2 &= ~I2C_CR2_LAST; -+ -+ /* Disable DMA Request */ -+ hi2c->Instance->CR2 &= ~I2C_CR2_DMAEN; -+ -+ hi2c->XferCount = 0U; -+ -+ /* Check if Errors has been detected during transfer */ -+ if(hi2c->ErrorCode != HAL_I2C_ERROR_NONE) -+ { -+ HAL_I2C_ErrorCallback(hi2c); -+ } -+ else -+ { -+ hi2c->State = HAL_I2C_STATE_READY; -+ -+ if(hi2c->Mode == HAL_I2C_MODE_MEM) -+ { -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ HAL_I2C_MemRxCpltCallback(hi2c); -+ } -+ else -+ { -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ HAL_I2C_MasterRxCpltCallback(hi2c); -+ } -+ } -+ } -+} -+ -+/** -+ * @brief DMA I2C communication error callback. -+ * @param hdma DMA handle -+ * @retval None -+ */ -+static void I2C_DMAError(DMA_HandleTypeDef *hdma) -+{ -+ I2C_HandleTypeDef* hi2c = (I2C_HandleTypeDef*)((DMA_HandleTypeDef*)hdma)->Parent; -+ -+ /* Ignore DMA FIFO error */ -+ if(HAL_DMA_GetError(hdma) != HAL_DMA_ERROR_FE) -+ { -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ hi2c->XferCount = 0U; -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ hi2c->ErrorCode |= HAL_I2C_ERROR_DMA; -+ -+ HAL_I2C_ErrorCallback(hi2c); -+ } -+} -+ -+/** -+ * @brief DMA I2C communication abort callback -+ * (To be called at end of DMA Abort procedure). -+ * @param hdma DMA handle. -+ * @retval None -+ */ -+static void I2C_DMAAbort(DMA_HandleTypeDef *hdma) -+{ -+ I2C_HandleTypeDef* hi2c = ( I2C_HandleTypeDef* )((DMA_HandleTypeDef* )hdma)->Parent; -+ -+ /* Disable Acknowledge */ -+ hi2c->Instance->CR1 &= ~I2C_CR1_ACK; -+ -+ hi2c->XferCount = 0U; -+ -+ /* Reset XferAbortCallback */ -+ hi2c->hdmatx->XferAbortCallback = NULL; -+ hi2c->hdmarx->XferAbortCallback = NULL; -+ -+ /* Check if come from abort from user */ -+ if(hi2c->State == HAL_I2C_STATE_ABORT) -+ { -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ -+ /* Disable I2C peripheral to prevent dummy data in buffer */ -+ __HAL_I2C_DISABLE(hi2c); -+ -+ /* Call the corresponding callback to inform upper layer of End of Transfer */ -+ HAL_I2C_AbortCpltCallback(hi2c); -+ } -+ else -+ { -+ hi2c->State = HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Disable I2C peripheral to prevent dummy data in buffer */ -+ __HAL_I2C_DISABLE(hi2c); -+ -+ /* Call the corresponding callback to inform upper layer of End of Transfer */ -+ HAL_I2C_ErrorCallback(hi2c); -+ } -+} -+ -+/** -+ * @brief This function handles I2C Communication Timeout. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @param Flag specifies the I2C flag to check. -+ * @param Status The new Flag status (SET or RESET). -+ * @param Timeout Timeout duration -+ * @param Tickstart Tick start value -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_WaitOnFlagUntilTimeout(I2C_HandleTypeDef *hi2c, uint32_t Flag, FlagStatus Status, uint32_t Timeout, uint32_t Tickstart) -+{ -+ /* Wait until flag is set */ -+ while((__HAL_I2C_GET_FLAG(hi2c, Flag) ? SET : RESET) == Status) -+ { -+ /* Check for the Timeout */ -+ if(Timeout != HAL_MAX_DELAY) -+ { -+ if((Timeout == 0U)||((HAL_GetTick() - Tickstart ) > Timeout)) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ hi2c->Mode = HAL_I2C_MODE_NONE; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ } -+ -+ return HAL_OK; -+} -+ -+/** -+ * @brief This function handles I2C Communication Timeout for Master addressing phase. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for I2C module -+ * @param Flag specifies the I2C flag to check. -+ * @param Timeout Timeout duration -+ * @param Tickstart Tick start value -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_WaitOnMasterAddressFlagUntilTimeout(I2C_HandleTypeDef *hi2c, uint32_t Flag, uint32_t Timeout, uint32_t Tickstart) -+{ -+ while(__HAL_I2C_GET_FLAG(hi2c, Flag) == RESET) -+ { -+ if(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_AF) == SET) -+ { -+ /* Generate Stop */ -+ hi2c->Instance->CR1 |= I2C_CR1_STOP; -+ -+ /* Clear AF Flag */ -+ __HAL_I2C_CLEAR_FLAG(hi2c, I2C_FLAG_AF); -+ -+ hi2c->ErrorCode = HAL_I2C_ERROR_AF; -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_ERROR; -+ } -+ -+ /* Check for the Timeout */ -+ if(Timeout != HAL_MAX_DELAY) -+ { -+ if((Timeout == 0U)||((HAL_GetTick() - Tickstart ) > Timeout)) -+ { -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @brief This function handles I2C Communication Timeout for specific usage of TXE flag. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param Timeout Timeout duration -+ * @param Tickstart Tick start value -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_WaitOnTXEFlagUntilTimeout(I2C_HandleTypeDef *hi2c, uint32_t Timeout, uint32_t Tickstart) -+{ -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_TXE) == RESET) -+ { -+ /* Check if a NACK is detected */ -+ if(I2C_IsAcknowledgeFailed(hi2c) != HAL_OK) -+ { -+ return HAL_ERROR; -+ } -+ -+ /* Check for the Timeout */ -+ if(Timeout != HAL_MAX_DELAY) -+ { -+ if((Timeout == 0U) || ((HAL_GetTick()-Tickstart) > Timeout)) -+ { -+ hi2c->ErrorCode |= HAL_I2C_ERROR_TIMEOUT; -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @brief This function handles I2C Communication Timeout for specific usage of BTF flag. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param Timeout Timeout duration -+ * @param Tickstart Tick start value -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_WaitOnBTFFlagUntilTimeout(I2C_HandleTypeDef *hi2c, uint32_t Timeout, uint32_t Tickstart) -+{ -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_BTF) == RESET) -+ { -+ /* Check if a NACK is detected */ -+ if(I2C_IsAcknowledgeFailed(hi2c) != HAL_OK) -+ { -+ return HAL_ERROR; -+ } -+ -+ /* Check for the Timeout */ -+ if(Timeout != HAL_MAX_DELAY) -+ { -+ if((Timeout == 0U) || ((HAL_GetTick()-Tickstart) > Timeout)) -+ { -+ hi2c->ErrorCode |= HAL_I2C_ERROR_TIMEOUT; -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @brief This function handles I2C Communication Timeout for specific usage of STOP flag. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param Timeout Timeout duration -+ * @param Tickstart Tick start value -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_WaitOnSTOPFlagUntilTimeout(I2C_HandleTypeDef *hi2c, uint32_t Timeout, uint32_t Tickstart) -+{ -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_STOPF) == RESET) -+ { -+ /* Check if a NACK is detected */ -+ if(I2C_IsAcknowledgeFailed(hi2c) != HAL_OK) -+ { -+ return HAL_ERROR; -+ } -+ -+ /* Check for the Timeout */ -+ if((Timeout == 0U) || ((HAL_GetTick()-Tickstart) > Timeout)) -+ { -+ hi2c->ErrorCode |= HAL_I2C_ERROR_TIMEOUT; -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @brief This function handles I2C Communication Timeout for specific usage of RXNE flag. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @param Timeout Timeout duration -+ * @param Tickstart Tick start value -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_WaitOnRXNEFlagUntilTimeout(I2C_HandleTypeDef *hi2c, uint32_t Timeout, uint32_t Tickstart) -+{ -+ -+ while(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_RXNE) == RESET) -+ { -+ /* Check if a STOPF is detected */ -+ if(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_STOPF) == SET) -+ { -+ /* Clear STOP Flag */ -+ __HAL_I2C_CLEAR_FLAG(hi2c, I2C_FLAG_STOPF); -+ -+ hi2c->ErrorCode = HAL_I2C_ERROR_NONE; -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_ERROR; -+ } -+ -+ /* Check for the Timeout */ -+ if((Timeout == 0U) || ((HAL_GetTick()-Tickstart) > Timeout)) -+ { -+ hi2c->ErrorCode |= HAL_I2C_ERROR_TIMEOUT; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_TIMEOUT; -+ } -+ } -+ return HAL_OK; -+} -+ -+/** -+ * @brief This function handles Acknowledge failed detection during an I2C Communication. -+ * @param hi2c Pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2C. -+ * @retval HAL status -+ */ -+static HAL_StatusTypeDef I2C_IsAcknowledgeFailed(I2C_HandleTypeDef *hi2c) -+{ -+ if(__HAL_I2C_GET_FLAG(hi2c, I2C_FLAG_AF) == SET) -+ { -+ /* Clear NACKF Flag */ -+ __HAL_I2C_CLEAR_FLAG(hi2c, I2C_FLAG_AF); -+ -+ hi2c->ErrorCode = HAL_I2C_ERROR_AF; -+ hi2c->PreviousState = I2C_STATE_NONE; -+ hi2c->State= HAL_I2C_STATE_READY; -+ -+ /* Process Unlocked */ -+ __HAL_UNLOCK(hi2c); -+ -+ return HAL_ERROR; -+ } -+ return HAL_OK; -+} -+/** -+ * @} -+ */ -+ -+#endif /* HAL_I2C_MODULE_ENABLED */ -+ -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+ -+/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/ -diff --git a/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal_i2c_ex.c b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal_i2c_ex.c -new file mode 100644 -index 0000000..de8f160 ---- /dev/null -+++ b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal_i2c_ex.c -@@ -0,0 +1,204 @@ -+/** -+ ****************************************************************************** -+ * @file stm32f4xx_hal_i2c_ex.c -+ * @author MCD Application Team -+ * @brief I2C Extension HAL module driver. -+ * This file provides firmware functions to manage the following -+ * functionalities of I2C extension peripheral: -+ * + Extension features functions -+ * -+ @verbatim -+ ============================================================================== -+ ##### I2C peripheral extension features ##### -+ ============================================================================== -+ -+ [..] Comparing to other previous devices, the I2C interface for STM32F427xx/437xx/ -+ 429xx/439xx devices contains the following additional features : -+ -+ (+) Possibility to disable or enable Analog Noise Filter -+ (+) Use of a configured Digital Noise Filter -+ -+ ##### How to use this driver ##### -+ ============================================================================== -+ [..] This driver provides functions to configure Noise Filter -+ (#) Configure I2C Analog noise filter using the function HAL_I2C_AnalogFilter_Config() -+ (#) Configure I2C Digital noise filter using the function HAL_I2C_DigitalFilter_Config() -+ -+ @endverbatim -+ ****************************************************************************** -+ * @attention -+ * -+ *

© COPYRIGHT(c) 2017 STMicroelectronics

-+ * -+ * Redistribution and use in source and binary forms, with or without modification, -+ * are permitted provided that the following conditions are met: -+ * 1. Redistributions of source code must retain the above copyright notice, -+ * this list of conditions and the following disclaimer. -+ * 2. Redistributions in binary form must reproduce the above copyright notice, -+ * this list of conditions and the following disclaimer in the documentation -+ * and/or other materials provided with the distribution. -+ * 3. Neither the name of STMicroelectronics nor the names of its contributors -+ * may be used to endorse or promote products derived from this software -+ * without specific prior written permission. -+ * -+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" -+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE -+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE -+ * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE -+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL -+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR -+ * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER -+ * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, -+ * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE -+ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. -+ * -+ ****************************************************************************** -+ */ -+ -+/* Includes ------------------------------------------------------------------*/ -+#include "stm32f4xx_hal.h" -+ -+/** @addtogroup STM32F4xx_HAL_Driver -+ * @{ -+ */ -+ -+/** @defgroup I2CEx I2CEx -+ * @brief I2C HAL module driver -+ * @{ -+ */ -+ -+#ifdef HAL_I2C_MODULE_ENABLED -+ -+#if defined(STM32F427xx) || defined(STM32F437xx) || defined(STM32F429xx) || defined(STM32F439xx) ||\ -+ defined(STM32F401xC) || defined(STM32F401xE) || defined(STM32F411xE) || defined(STM32F446xx) ||\ -+ defined(STM32F469xx) || defined(STM32F479xx) || defined(STM32F413xx) || defined(STM32F423xx) -+/* Private typedef -----------------------------------------------------------*/ -+/* Private define ------------------------------------------------------------*/ -+/* Private macro -------------------------------------------------------------*/ -+/* Private variables ---------------------------------------------------------*/ -+/* Private function prototypes -----------------------------------------------*/ -+/* Exported functions --------------------------------------------------------*/ -+/** @defgroup I2CEx_Exported_Functions I2C Exported Functions -+ * @{ -+ */ -+ -+ -+/** @defgroup I2CEx_Exported_Functions_Group1 Extension features functions -+ * @brief Extension features functions -+ * -+@verbatim -+ =============================================================================== -+ ##### Extension features functions ##### -+ =============================================================================== -+ [..] This section provides functions allowing to: -+ (+) Configure Noise Filters -+ -+@endverbatim -+ * @{ -+ */ -+ -+/** -+ * @brief Configures I2C Analog noise filter. -+ * @param hi2c pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2Cx peripheral. -+ * @param AnalogFilter new state of the Analog filter. -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2CEx_ConfigAnalogFilter(I2C_HandleTypeDef *hi2c, uint32_t AnalogFilter) -+{ -+ /* Check the parameters */ -+ assert_param(IS_I2C_ALL_INSTANCE(hi2c->Instance)); -+ assert_param(IS_I2C_ANALOG_FILTER(AnalogFilter)); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ hi2c->State = HAL_I2C_STATE_BUSY; -+ -+ /* Disable the selected I2C peripheral */ -+ __HAL_I2C_DISABLE(hi2c); -+ -+ /* Reset I2Cx ANOFF bit */ -+ hi2c->Instance->FLTR &= ~(I2C_FLTR_ANOFF); -+ -+ /* Disable the analog filter */ -+ hi2c->Instance->FLTR |= AnalogFilter; -+ -+ __HAL_I2C_ENABLE(hi2c); -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @brief Configures I2C Digital noise filter. -+ * @param hi2c pointer to a I2C_HandleTypeDef structure that contains -+ * the configuration information for the specified I2Cx peripheral. -+ * @param DigitalFilter Coefficient of digital noise filter between 0x00 and 0x0F. -+ * @retval HAL status -+ */ -+HAL_StatusTypeDef HAL_I2CEx_ConfigDigitalFilter(I2C_HandleTypeDef *hi2c, uint32_t DigitalFilter) -+{ -+ uint16_t tmpreg = 0; -+ -+ /* Check the parameters */ -+ assert_param(IS_I2C_ALL_INSTANCE(hi2c->Instance)); -+ assert_param(IS_I2C_DIGITAL_FILTER(DigitalFilter)); -+ -+ if(hi2c->State == HAL_I2C_STATE_READY) -+ { -+ hi2c->State = HAL_I2C_STATE_BUSY; -+ -+ /* Disable the selected I2C peripheral */ -+ __HAL_I2C_DISABLE(hi2c); -+ -+ /* Get the old register value */ -+ tmpreg = hi2c->Instance->FLTR; -+ -+ /* Reset I2Cx DNF bit [3:0] */ -+ tmpreg &= ~(I2C_FLTR_DNF); -+ -+ /* Set I2Cx DNF coefficient */ -+ tmpreg |= DigitalFilter; -+ -+ /* Store the new register value */ -+ hi2c->Instance->FLTR = tmpreg; -+ -+ __HAL_I2C_ENABLE(hi2c); -+ -+ hi2c->State = HAL_I2C_STATE_READY; -+ -+ return HAL_OK; -+ } -+ else -+ { -+ return HAL_BUSY; -+ } -+} -+ -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+#endif /* STM32F427xx || STM32F429xx || STM32F437xx || STM32F439xx || STM32F401xC ||\ -+ STM32F401xE || STM32F446xx || STM32F469xx || STM32F479xx || STM32F413xx ||\ -+ STM32F423xx */ -+ -+#endif /* HAL_I2C_MODULE_ENABLED */ -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+ -+/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/ -diff --git a/Firmware/Board/v3/Inc/i2c.h b/Firmware/Board/v3/Inc/i2c.h -new file mode 100644 -index 0000000..f449b88 ---- /dev/null -+++ b/Firmware/Board/v3/Inc/i2c.h -@@ -0,0 +1,91 @@ -+/** -+ ****************************************************************************** -+ * File Name : I2C.h -+ * Description : This file provides code for the configuration -+ * of the I2C instances. -+ ****************************************************************************** -+ * This notice applies to any and all portions of this file -+ * that are not between comment pairs USER CODE BEGIN and -+ * USER CODE END. Other portions of this file, whether -+ * inserted by the user or by software development tools -+ * are owned by their respective copyright owners. -+ * -+ * Copyright (c) 2018 STMicroelectronics International N.V. -+ * All rights reserved. -+ * -+ * Redistribution and use in source and binary forms, with or without -+ * modification, are permitted, provided that the following conditions are met: -+ * -+ * 1. Redistribution of source code must retain the above copyright notice, -+ * this list of conditions and the following disclaimer. -+ * 2. Redistributions in binary form must reproduce the above copyright notice, -+ * this list of conditions and the following disclaimer in the documentation -+ * and/or other materials provided with the distribution. -+ * 3. Neither the name of STMicroelectronics nor the names of other -+ * contributors to this software may be used to endorse or promote products -+ * derived from this software without specific written permission. -+ * 4. This software, including modifications and/or derivative works of this -+ * software, must execute solely and exclusively on microcontroller or -+ * microprocessor devices manufactured by or for STMicroelectronics. -+ * 5. Redistribution and use of this software other than as permitted under -+ * this license is void and will automatically terminate your rights under -+ * this license. -+ * -+ * THIS SOFTWARE IS PROVIDED BY STMICROELECTRONICS AND CONTRIBUTORS "AS IS" -+ * AND ANY EXPRESS, IMPLIED OR STATUTORY WARRANTIES, INCLUDING, BUT NOT -+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS FOR A -+ * PARTICULAR PURPOSE AND NON-INFRINGEMENT OF THIRD PARTY INTELLECTUAL PROPERTY -+ * RIGHTS ARE DISCLAIMED TO THE FULLEST EXTENT PERMITTED BY LAW. IN NO EVENT -+ * SHALL STMICROELECTRONICS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, -+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT -+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, -+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF -+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING -+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, -+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. -+ * -+ ****************************************************************************** -+ */ -+/* Define to prevent recursive inclusion -------------------------------------*/ -+#ifndef __i2c_H -+#define __i2c_H -+#ifdef __cplusplus -+ extern "C" { -+#endif -+ -+/* Includes ------------------------------------------------------------------*/ -+#include "stm32f4xx_hal.h" -+#include "main.h" -+ -+/* USER CODE BEGIN Includes */ -+ -+/* USER CODE END Includes */ -+ -+extern I2C_HandleTypeDef hi2c1; -+ -+/* USER CODE BEGIN Private defines */ -+ -+/* USER CODE END Private defines */ -+ -+extern void _Error_Handler(char *, int); -+ -+void MX_I2C1_Init(uint8_t addr); -+ -+/* USER CODE BEGIN Prototypes */ -+ -+/* USER CODE END Prototypes */ -+ -+#ifdef __cplusplus -+} -+#endif -+#endif /*__ i2c_H */ -+ -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+ -+/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/ -diff --git a/Firmware/Board/v3/Inc/stm32f4xx_hal_conf.h b/Firmware/Board/v3/Inc/stm32f4xx_hal_conf.h -index d0f48f5..b3ef59a 100644 ---- a/Firmware/Board/v3/Inc/stm32f4xx_hal_conf.h -+++ b/Firmware/Board/v3/Inc/stm32f4xx_hal_conf.h -@@ -65,7 +65,7 @@ - /* #define HAL_SRAM_MODULE_ENABLED */ - /* #define HAL_SDRAM_MODULE_ENABLED */ - /* #define HAL_HASH_MODULE_ENABLED */ --/* #define HAL_I2C_MODULE_ENABLED */ -+#define HAL_I2C_MODULE_ENABLED - /* #define HAL_I2S_MODULE_ENABLED */ - /* #define HAL_IWDG_MODULE_ENABLED */ - /* #define HAL_LTDC_MODULE_ENABLED */ -diff --git a/Firmware/Board/v3/Src/i2c.c b/Firmware/Board/v3/Src/i2c.c -new file mode 100644 -index 0000000..bae77f1 ---- /dev/null -+++ b/Firmware/Board/v3/Src/i2c.c -@@ -0,0 +1,198 @@ -+/** -+ ****************************************************************************** -+ * File Name : I2C.c -+ * Description : This file provides code for the configuration -+ * of the I2C instances. -+ ****************************************************************************** -+ * This notice applies to any and all portions of this file -+ * that are not between comment pairs USER CODE BEGIN and -+ * USER CODE END. Other portions of this file, whether -+ * inserted by the user or by software development tools -+ * are owned by their respective copyright owners. -+ * -+ * Copyright (c) 2018 STMicroelectronics International N.V. -+ * All rights reserved. -+ * -+ * Redistribution and use in source and binary forms, with or without -+ * modification, are permitted, provided that the following conditions are met: -+ * -+ * 1. Redistribution of source code must retain the above copyright notice, -+ * this list of conditions and the following disclaimer. -+ * 2. Redistributions in binary form must reproduce the above copyright notice, -+ * this list of conditions and the following disclaimer in the documentation -+ * and/or other materials provided with the distribution. -+ * 3. Neither the name of STMicroelectronics nor the names of other -+ * contributors to this software may be used to endorse or promote products -+ * derived from this software without specific written permission. -+ * 4. This software, including modifications and/or derivative works of this -+ * software, must execute solely and exclusively on microcontroller or -+ * microprocessor devices manufactured by or for STMicroelectronics. -+ * 5. Redistribution and use of this software other than as permitted under -+ * this license is void and will automatically terminate your rights under -+ * this license. -+ * -+ * THIS SOFTWARE IS PROVIDED BY STMICROELECTRONICS AND CONTRIBUTORS "AS IS" -+ * AND ANY EXPRESS, IMPLIED OR STATUTORY WARRANTIES, INCLUDING, BUT NOT -+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS FOR A -+ * PARTICULAR PURPOSE AND NON-INFRINGEMENT OF THIRD PARTY INTELLECTUAL PROPERTY -+ * RIGHTS ARE DISCLAIMED TO THE FULLEST EXTENT PERMITTED BY LAW. IN NO EVENT -+ * SHALL STMICROELECTRONICS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, -+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT -+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, -+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF -+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING -+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, -+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. -+ * -+ ****************************************************************************** -+ */ -+ -+/* Includes ------------------------------------------------------------------*/ -+#include "i2c.h" -+ -+#include "gpio.h" -+#include "dma.h" -+ -+/* USER CODE BEGIN 0 */ -+ -+/* USER CODE END 0 */ -+ -+I2C_HandleTypeDef hi2c1; -+DMA_HandleTypeDef hdma_i2c1_rx; -+DMA_HandleTypeDef hdma_i2c1_tx; -+ -+/* I2C1 init function */ -+void MX_I2C1_Init(uint8_t addr) -+{ -+ -+ hi2c1.Instance = I2C1; -+ hi2c1.Init.ClockSpeed = 100000; -+ hi2c1.Init.DutyCycle = I2C_DUTYCYCLE_2; -+ hi2c1.Init.OwnAddress1 = addr << 1; -+ hi2c1.Init.AddressingMode = I2C_ADDRESSINGMODE_7BIT; -+ hi2c1.Init.DualAddressMode = I2C_DUALADDRESS_DISABLE; -+ hi2c1.Init.OwnAddress2 = 0; -+ hi2c1.Init.GeneralCallMode = I2C_GENERALCALL_DISABLE; -+ hi2c1.Init.NoStretchMode = I2C_NOSTRETCH_DISABLE; -+ if (HAL_I2C_Init(&hi2c1) != HAL_OK) -+ { -+ _Error_Handler(__FILE__, __LINE__); -+ } -+ -+} -+ -+void HAL_I2C_MspInit(I2C_HandleTypeDef* i2cHandle) -+{ -+ -+ GPIO_InitTypeDef GPIO_InitStruct; -+ if(i2cHandle->Instance==I2C1) -+ { -+ /* USER CODE BEGIN I2C1_MspInit 0 */ -+ -+ /* USER CODE END I2C1_MspInit 0 */ -+ -+ /**I2C1 GPIO Configuration -+ PB8 ------> I2C1_SCL -+ PB9 ------> I2C1_SDA -+ */ -+ GPIO_InitStruct.Pin = GPIO_PIN_8|GPIO_PIN_9; -+ GPIO_InitStruct.Mode = GPIO_MODE_AF_OD; -+ GPIO_InitStruct.Pull = GPIO_PULLUP; -+ GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH; -+ GPIO_InitStruct.Alternate = GPIO_AF4_I2C1; -+ HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); -+ -+ /* I2C1 clock enable */ -+ __HAL_RCC_I2C1_CLK_ENABLE(); -+ -+ /* I2C1 DMA Init */ -+ /* I2C1_RX Init */ -+ hdma_i2c1_rx.Instance = DMA1_Stream0; -+ hdma_i2c1_rx.Init.Channel = DMA_CHANNEL_1; -+ hdma_i2c1_rx.Init.Direction = DMA_PERIPH_TO_MEMORY; -+ hdma_i2c1_rx.Init.PeriphInc = DMA_PINC_DISABLE; -+ hdma_i2c1_rx.Init.MemInc = DMA_MINC_ENABLE; -+ hdma_i2c1_rx.Init.PeriphDataAlignment = DMA_PDATAALIGN_BYTE; -+ hdma_i2c1_rx.Init.MemDataAlignment = DMA_MDATAALIGN_BYTE; -+ hdma_i2c1_rx.Init.Mode = DMA_CIRCULAR; -+ hdma_i2c1_rx.Init.Priority = DMA_PRIORITY_LOW; -+ hdma_i2c1_rx.Init.FIFOMode = DMA_FIFOMODE_DISABLE; -+ if (HAL_DMA_Init(&hdma_i2c1_rx) != HAL_OK) -+ { -+ _Error_Handler(__FILE__, __LINE__); -+ } -+ -+ __HAL_LINKDMA(i2cHandle,hdmarx,hdma_i2c1_rx); -+ -+ /* I2C1_TX Init */ -+ hdma_i2c1_tx.Instance = DMA1_Stream6; -+ hdma_i2c1_tx.Init.Channel = DMA_CHANNEL_1; -+ hdma_i2c1_tx.Init.Direction = DMA_MEMORY_TO_PERIPH; -+ hdma_i2c1_tx.Init.PeriphInc = DMA_PINC_DISABLE; -+ hdma_i2c1_tx.Init.MemInc = DMA_MINC_ENABLE; -+ hdma_i2c1_tx.Init.PeriphDataAlignment = DMA_PDATAALIGN_BYTE; -+ hdma_i2c1_tx.Init.MemDataAlignment = DMA_MDATAALIGN_BYTE; -+ hdma_i2c1_tx.Init.Mode = DMA_NORMAL; -+ hdma_i2c1_tx.Init.Priority = DMA_PRIORITY_LOW; -+ hdma_i2c1_tx.Init.FIFOMode = DMA_FIFOMODE_DISABLE; -+ if (HAL_DMA_Init(&hdma_i2c1_tx) != HAL_OK) -+ { -+ _Error_Handler(__FILE__, __LINE__); -+ } -+ -+ __HAL_LINKDMA(i2cHandle,hdmatx,hdma_i2c1_tx); -+ -+ /* I2C1 interrupt Init */ -+ HAL_NVIC_SetPriority(I2C1_EV_IRQn, 5, 0); -+ HAL_NVIC_EnableIRQ(I2C1_EV_IRQn); -+ HAL_NVIC_SetPriority(I2C1_ER_IRQn, 5, 0); -+ HAL_NVIC_EnableIRQ(I2C1_ER_IRQn); -+ /* USER CODE BEGIN I2C1_MspInit 1 */ -+ -+ /* USER CODE END I2C1_MspInit 1 */ -+ } -+} -+ -+void HAL_I2C_MspDeInit(I2C_HandleTypeDef* i2cHandle) -+{ -+ -+ if(i2cHandle->Instance==I2C1) -+ { -+ /* USER CODE BEGIN I2C1_MspDeInit 0 */ -+ -+ /* USER CODE END I2C1_MspDeInit 0 */ -+ /* Peripheral clock disable */ -+ __HAL_RCC_I2C1_CLK_DISABLE(); -+ -+ /**I2C1 GPIO Configuration -+ PB8 ------> I2C1_SCL -+ PB9 ------> I2C1_SDA -+ */ -+ HAL_GPIO_DeInit(GPIOB, GPIO_PIN_8|GPIO_PIN_9); -+ -+ /* I2C1 DMA DeInit */ -+ HAL_DMA_DeInit(i2cHandle->hdmarx); -+ HAL_DMA_DeInit(i2cHandle->hdmatx); -+ -+ /* I2C1 interrupt Deinit */ -+ HAL_NVIC_DisableIRQ(I2C1_EV_IRQn); -+ HAL_NVIC_DisableIRQ(I2C1_ER_IRQn); -+ /* USER CODE BEGIN I2C1_MspDeInit 1 */ -+ -+ /* USER CODE END I2C1_MspDeInit 1 */ -+ } -+} -+ -+/* USER CODE BEGIN 1 */ -+ -+/* USER CODE END 1 */ -+ -+/** -+ * @} -+ */ -+ -+/** -+ * @} -+ */ -+ -+/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/ -diff --git a/Firmware/Board/v3/Src/main.c b/Firmware/Board/v3/Src/main.c -index 987e0bd..efaeef1 100644 ---- a/Firmware/Board/v3/Src/main.c -+++ b/Firmware/Board/v3/Src/main.c -@@ -187,7 +187,6 @@ int main(void) - MX_ADC3_Init(); - MX_TIM2_Init(); - MX_UART4_Init(); -- MX_CAN1_Init(); - /* USER CODE BEGIN 2 */ - - //Required to use OC4 for ADC triggering. --- -2.17.0 - diff --git a/Firmware/Board/v3/0002-FreeRTOS-constness-fixes.patch b/Firmware/Board/v3/0002-FreeRTOS-constness-fixes.patch deleted file mode 100644 index afe0326e..00000000 --- a/Firmware/Board/v3/0002-FreeRTOS-constness-fixes.patch +++ /dev/null @@ -1,64 +0,0 @@ -From 510ead2b159e1d8116e5241066c54a7bf8b7bfbe Mon Sep 17 00:00:00 2001 -From: Samuel Sadok -Date: Mon, 26 Mar 2018 15:29:44 -0700 -Subject: [PATCH] FreeRTOS constness fixes - - - make thread names const char * - - make thread argument non-const void* ---- - .../Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h | 6 +++--- - Firmware/Board/v3/Src/freertos.c | 4 ++-- - 2 files changed, 5 insertions(+), 5 deletions(-) - -diff --git a/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h b/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h -index 09cdf27..754be24 100644 ---- a/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h -+++ b/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h -@@ -270,11 +270,11 @@ typedef enum { - - /// Entry point of a thread. - /// \note MUST REMAIN UNCHANGED: \b os_pthread shall be consistent in every CMSIS-RTOS. --typedef void (*os_pthread) (void const *argument); -+typedef void (*os_pthread) (void *argument); - - /// Entry point of a timer call back function. - /// \note MUST REMAIN UNCHANGED: \b os_ptimer shall be consistent in every CMSIS-RTOS. --typedef void (*os_ptimer) (void const *argument); -+typedef void (*os_ptimer) (void *argument); - - // >>> the following data type definitions may shall adapted towards a specific RTOS - -@@ -323,7 +323,7 @@ typedef StaticQueue_t osStaticMessageQDef_t; - /// Thread Definition structure contains startup information of a thread. - /// \note CAN BE CHANGED: \b os_thread_def is implementation specific in every CMSIS-RTOS. - typedef struct os_thread_def { -- char *name; ///< Thread name -+ const char *name; ///< Thread name - os_pthread pthread; ///< start address of thread function - osPriority tpriority; ///< initial thread priority - uint32_t instances; ///< maximum number of instances of that thread function -diff --git a/Firmware/Board/v3/Src/freertos.c b/Firmware/Board/v3/Src/freertos.c -index 6eaea82..b247994 100644 ---- a/Firmware/Board/v3/Src/freertos.c -+++ b/Firmware/Board/v3/Src/freertos.c -@@ -75,7 +75,7 @@ uint8_t ucHeap[configTOTAL_HEAP_SIZE]; - /* USER CODE END Variables */ - - /* Function prototypes -------------------------------------------------------*/ --void StartDefaultTask(void const * argument); -+void StartDefaultTask(void * argument); - - extern void MX_USB_DEVICE_Init(void); - void MX_FREERTOS_Init(void); /* (MISRA C 2004 rule 8.1) */ -@@ -147,7 +147,7 @@ void MX_FREERTOS_Init(void) { - } - - /* StartDefaultTask function */ --void StartDefaultTask(void const * argument) -+void StartDefaultTask(void * argument) - { - /* init code for USB_DEVICE */ - MX_USB_DEVICE_Init(); --- -2.16.2 - diff --git a/Firmware/Board/v3/0003-disable-IRQ-for-DMA2_Stream0.patch b/Firmware/Board/v3/0003-disable-IRQ-for-DMA2_Stream0.patch deleted file mode 100644 index 282317d1..00000000 --- a/Firmware/Board/v3/0003-disable-IRQ-for-DMA2_Stream0.patch +++ /dev/null @@ -1,33 +0,0 @@ -From ab5ca860b3729d76a9c43c485776147ab69d2342 Mon Sep 17 00:00:00 2001 -From: Samuel Sadok -Date: Mon, 26 Mar 2018 19:02:45 -0700 -Subject: [PATCH] disable IRQ for DMA2_Stream0 - -This DMA stream is used to read values from ADC1 -while ADC1 cycles through it's sequence of input -channels. No interrupts are required to make -this work. ---- - Firmware/Board/v3/Src/dma.c | 6 ++++-- - 1 file changed, 4 insertions(+), 2 deletions(-) - -diff --git a/Firmware/Board/v3/Src/dma.c b/Firmware/Board/v3/Src/dma.c -index 55d5e03..3de873a 100644 ---- a/Firmware/Board/v3/Src/dma.c -+++ b/Firmware/Board/v3/Src/dma.c -@@ -78,8 +78,10 @@ void MX_DMA_Init(void) - HAL_NVIC_SetPriority(DMA1_Stream4_IRQn, 5, 0); - HAL_NVIC_EnableIRQ(DMA1_Stream4_IRQn); - /* DMA2_Stream0_IRQn interrupt configuration */ -- HAL_NVIC_SetPriority(DMA2_Stream0_IRQn, 5, 0); -- HAL_NVIC_EnableIRQ(DMA2_Stream0_IRQn); -+ // Dear STM, no we _don't_ want to fire an interrupt for this DMA -+ // (it's not possible to deselect this in CubeMX) -+ //HAL_NVIC_SetPriority(DMA2_Stream0_IRQn, 5, 0); -+ //HAL_NVIC_EnableIRQ(DMA2_Stream0_IRQn); - - } - --- -2.16.2 - diff --git a/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_def.h b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_def.h index 06414648..6d5e5b22 100644 --- a/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_def.h +++ b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_def.h @@ -70,6 +70,9 @@ typedef enum } HAL_LockTypeDef; /* Exported macro ------------------------------------------------------------*/ + +#define UNUSED(X) (void)X /* To avoid gcc/g++ warnings */ + #define HAL_MAX_DELAY 0xFFFFFFFFU #define HAL_IS_BIT_SET(REG, BIT) (((REG) & (BIT)) != RESET) @@ -79,9 +82,7 @@ typedef enum do{ \ (__HANDLE__)->__PPP_DMA_FIELD__ = &(__DMA_HANDLE__); \ (__DMA_HANDLE__).Parent = (__HANDLE__); \ - } while(0) - -#define UNUSED(x) ((void)(x)) + } while(0U) /** @brief Reset the Handle's State field. * @param __HANDLE__ specifies the Peripheral Handle. @@ -135,7 +136,7 @@ typedef enum /* Macro to get variable aligned on 4-bytes, for __ICCARM__ the directive "#pragma data_alignment=4" must be used instead */ #if defined ( __GNUC__ ) && !defined (__CC_ARM) /* GNU Compiler */ #ifndef __ALIGN_END - #define __ALIGN_END __attribute__ ((aligned (4))) +#define __ALIGN_END __attribute__ ((aligned (4))) #endif /* __ALIGN_END */ #ifndef __ALIGN_BEGIN #define __ALIGN_BEGIN @@ -146,7 +147,7 @@ typedef enum #endif /* __ALIGN_END */ #ifndef __ALIGN_BEGIN #if defined (__CC_ARM) /* ARM Compiler */ - #define __ALIGN_BEGIN __align(4) +#define __ALIGN_BEGIN __align(4) #elif defined (__ICCARM__) /* IAR Compiler */ #define __ALIGN_BEGIN #endif /* __CC_ARM */ @@ -167,14 +168,14 @@ typedef enum Available memory areas are declared in the 'Target' tab of the 'Options for Target' dialog. */ -#define __RAM_FUNC HAL_StatusTypeDef +#define __RAM_FUNC #elif defined ( __ICCARM__ ) /* ICCARM Compiler --------------- RAM functions are defined using a specific toolchain keyword "__ramfunc". */ -#define __RAM_FUNC __ramfunc HAL_StatusTypeDef +#define __RAM_FUNC __ramfunc #elif defined ( __GNUC__ ) /* GNU Compiler @@ -182,7 +183,7 @@ typedef enum RAM functions are defined using a specific toolchain attribute "__attribute__((section(".RamFunc")))". */ -#define __RAM_FUNC HAL_StatusTypeDef __attribute__((section(".RamFunc"))) +#define __RAM_FUNC __attribute__((section(".RamFunc"))) #endif diff --git a/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_flash_ramfunc.h b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_flash_ramfunc.h index 500d33ad..fa7e4906 100644 --- a/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_flash_ramfunc.h +++ b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Inc/stm32f4xx_hal_flash_ramfunc.h @@ -64,10 +64,10 @@ /** @addtogroup FLASH_RAMFUNC_Exported_Functions_Group1 * @{ */ -__RAM_FUNC HAL_FLASHEx_StopFlashInterfaceClk(void); -__RAM_FUNC HAL_FLASHEx_StartFlashInterfaceClk(void); -__RAM_FUNC HAL_FLASHEx_EnableFlashSleepMode(void); -__RAM_FUNC HAL_FLASHEx_DisableFlashSleepMode(void); +__RAM_FUNC HAL_StatusTypeDef HAL_FLASHEx_StopFlashInterfaceClk(void); +__RAM_FUNC HAL_StatusTypeDef HAL_FLASHEx_StartFlashInterfaceClk(void); +__RAM_FUNC HAL_StatusTypeDef HAL_FLASHEx_EnableFlashSleepMode(void); +__RAM_FUNC HAL_StatusTypeDef HAL_FLASHEx_DisableFlashSleepMode(void); /** * @} */ diff --git a/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal.c b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal.c index bf966f9a..1d6da26b 100644 --- a/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal.c +++ b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal.c @@ -66,11 +66,11 @@ * @{ */ /** - * @brief STM32F4xx HAL Driver version number V1.7.3 + * @brief STM32F4xx HAL Driver version number V1.7.4 */ #define __STM32F4xx_HAL_VERSION_MAIN (0x01U) /*!< [31:24] main version */ #define __STM32F4xx_HAL_VERSION_SUB1 (0x07U) /*!< [23:16] sub1 version */ -#define __STM32F4xx_HAL_VERSION_SUB2 (0x03U) /*!< [15:8] sub2 version */ +#define __STM32F4xx_HAL_VERSION_SUB2 (0x04U) /*!< [15:8] sub2 version */ #define __STM32F4xx_HAL_VERSION_RC (0x00U) /*!< [7:0] release candidate */ #define __STM32F4xx_HAL_VERSION ((__STM32F4xx_HAL_VERSION_MAIN << 24U)\ |(__STM32F4xx_HAL_VERSION_SUB1 << 16U)\ diff --git a/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal_flash_ramfunc.c b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal_flash_ramfunc.c index fab41154..b896d072 100644 --- a/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal_flash_ramfunc.c +++ b/Firmware/Board/v3/Drivers/STM32F4xx_HAL_Driver/Src/stm32f4xx_hal_flash_ramfunc.c @@ -107,9 +107,9 @@ * @note This mode is only available for STM32F41xxx/STM32F446xx devices. * @note This mode couldn't be set while executing with the flash itself. * It should be done with specific routine executed from RAM. - * @retval None + * @retval HAL status */ -__RAM_FUNC HAL_FLASHEx_StopFlashInterfaceClk(void) +__RAM_FUNC HAL_StatusTypeDef HAL_FLASHEx_StopFlashInterfaceClk(void) { /* Enable Power ctrl clock */ __HAL_RCC_PWR_CLK_ENABLE(); @@ -124,9 +124,9 @@ __RAM_FUNC HAL_FLASHEx_StopFlashInterfaceClk(void) * @note This mode is only available for STM32F411xx/STM32F446xx devices. * @note This mode couldn't be set while executing with the flash itself. * It should be done with specific routine executed from RAM. - * @retval None + * @retval HAL status */ -__RAM_FUNC HAL_FLASHEx_StartFlashInterfaceClk(void) +__RAM_FUNC HAL_StatusTypeDef HAL_FLASHEx_StartFlashInterfaceClk(void) { /* Enable Power ctrl clock */ __HAL_RCC_PWR_CLK_ENABLE(); @@ -141,9 +141,9 @@ __RAM_FUNC HAL_FLASHEx_StartFlashInterfaceClk(void) * @note This mode is only available for STM32F41xxx/STM32F446xx devices. * @note This mode could n't be set while executing with the flash itself. * It should be done with specific routine executed from RAM. - * @retval None + * @retval HAL status */ -__RAM_FUNC HAL_FLASHEx_EnableFlashSleepMode(void) +__RAM_FUNC HAL_StatusTypeDef HAL_FLASHEx_EnableFlashSleepMode(void) { /* Enable Power ctrl clock */ __HAL_RCC_PWR_CLK_ENABLE(); @@ -158,9 +158,9 @@ __RAM_FUNC HAL_FLASHEx_EnableFlashSleepMode(void) * @note This mode is only available for STM32F41xxx/STM32F446xx devices. * @note This mode couldn't be set while executing with the flash itself. * It should be done with specific routine executed from RAM. - * @retval None + * @retval HAL status */ -__RAM_FUNC HAL_FLASHEx_DisableFlashSleepMode(void) +__RAM_FUNC HAL_StatusTypeDef HAL_FLASHEx_DisableFlashSleepMode(void) { /* Enable Power ctrl clock */ __HAL_RCC_PWR_CLK_ENABLE(); diff --git a/Firmware/Board/v3/Inc/FreeRTOSConfig.h b/Firmware/Board/v3/Inc/FreeRTOSConfig.h index 53280d99..715b0e67 100644 --- a/Firmware/Board/v3/Inc/FreeRTOSConfig.h +++ b/Firmware/Board/v3/Inc/FreeRTOSConfig.h @@ -89,7 +89,6 @@ /* Ensure stdint is only used by the compiler, and not the assembler. */ #if defined(__ICCARM__) || defined(__CC_ARM) || defined(__GNUC__) #include - #include "main.h" extern uint32_t SystemCoreClock; #endif @@ -153,7 +152,7 @@ See http://www.FreeRTOS.org/RTOS-Cortex-M3-M4.html. */ /* Normal assert() semantics without relying on the provision of an assert.h header file. */ -/* USER CODE BEGIN 1 */ +/* USER CODE BEGIN 1 */ #define configASSERT( x ) if ((x) == 0) {taskDISABLE_INTERRUPTS(); for( ;; );} /* USER CODE END 1 */ @@ -168,6 +167,7 @@ standard names. */ /* USER CODE BEGIN Defines */ /* Section where parameter definitions can be added (for instance, to override default ones in FreeRTOS.h) */ +#define configAPPLICATION_ALLOCATED_HEAP 1 // ucHeap allocated in freertos.c /* USER CODE END Defines */ #endif /* FREERTOS_CONFIG_H */ diff --git a/Firmware/Board/v3/Inc/main.h b/Firmware/Board/v3/Inc/main.h index 0a307122..d41b19ee 100644 --- a/Firmware/Board/v3/Inc/main.h +++ b/Firmware/Board/v3/Inc/main.h @@ -67,12 +67,12 @@ /* Private define ------------------------------------------------------------*/ #define TIM_1_8_CLOCK_HZ 168000000 -#define TIM_1_8_PERIOD_CLOCKS 10192 +#define TIM_1_8_PERIOD_CLOCKS 3500 #define TIM_1_8_DEADTIME_CLOCKS 20 #define TIM_APB1_CLOCK_HZ 84000000 #define TIM_APB1_PERIOD_CLOCKS 4096 #define TIM_APB1_DEADTIME_CLOCKS 40 -#define configAPPLICATION_ALLOCATED_HEAP 1 +#define TIM_1_8_RCR 2 #define M0_nCS_Pin GPIO_PIN_13 #define M0_nCS_GPIO_Port GPIOC @@ -168,8 +168,8 @@ //TODO: make this come automatically out of CubeMX somehow #define TIM_TIME_BASE TIM14 -#define CURRENT_MEAS_PERIOD ((float)(2*TIM_1_8_PERIOD_CLOCKS)/(float)TIM_1_8_CLOCK_HZ) -#define CURRENT_MEAS_HZ (TIM_1_8_CLOCK_HZ/(2*TIM_1_8_PERIOD_CLOCKS)) +#define CURRENT_MEAS_PERIOD ( (float)2*TIM_1_8_PERIOD_CLOCKS*(TIM_1_8_RCR+1) / (float)TIM_1_8_CLOCK_HZ ) +#define CURRENT_MEAS_HZ ( (float)(TIM_1_8_CLOCK_HZ) / (float)(2*TIM_1_8_PERIOD_CLOCKS*(TIM_1_8_RCR+1)) ) #if HW_VERSION_VOLTAGE == 48 #define VBUS_S_DIVIDER_RATIO 19.0f diff --git a/Firmware/Board/v3/Inc/prev_board_ver/main_V3_2.h b/Firmware/Board/v3/Inc/prev_board_ver/main_V3_2.h index bd3f6305..65f45efd 100644 --- a/Firmware/Board/v3/Inc/prev_board_ver/main_V3_2.h +++ b/Firmware/Board/v3/Inc/prev_board_ver/main_V3_2.h @@ -1,12 +1,12 @@ /* Private define ------------------------------------------------------------*/ #define TIM_1_8_CLOCK_HZ 168000000 -#define TIM_1_8_PERIOD_CLOCKS 10192 +#define TIM_1_8_PERIOD_CLOCKS 3500 #define TIM_1_8_DEADTIME_CLOCKS 20 #define TIM_APB1_CLOCK_HZ 84000000 #define TIM_APB1_PERIOD_CLOCKS 4096 #define TIM_APB1_DEADTIME_CLOCKS 40 -#define configAPPLICATION_ALLOCATED_HEAP 1 +#define TIM_1_8_RCR 2 #define M0_nCS_Pin GPIO_PIN_13 #define M0_nCS_GPIO_Port GPIOC diff --git a/Firmware/Board/v3/Inc/prev_board_ver/main_V3_4.h b/Firmware/Board/v3/Inc/prev_board_ver/main_V3_4.h index 19428406..64daaa4f 100644 --- a/Firmware/Board/v3/Inc/prev_board_ver/main_V3_4.h +++ b/Firmware/Board/v3/Inc/prev_board_ver/main_V3_4.h @@ -1,12 +1,12 @@ /* Private define ------------------------------------------------------------*/ #define TIM_1_8_CLOCK_HZ 168000000 -#define TIM_1_8_PERIOD_CLOCKS 10192 +#define TIM_1_8_PERIOD_CLOCKS 3500 #define TIM_1_8_DEADTIME_CLOCKS 20 #define TIM_APB1_CLOCK_HZ 84000000 #define TIM_APB1_PERIOD_CLOCKS 4096 #define TIM_APB1_DEADTIME_CLOCKS 40 -#define configAPPLICATION_ALLOCATED_HEAP 1 +#define TIM_1_8_RCR 2 #define M0_nCS_Pin GPIO_PIN_13 #define M0_nCS_GPIO_Port GPIOC diff --git a/Firmware/Board/v3/Inc/stm32f4xx_hal_conf.h b/Firmware/Board/v3/Inc/stm32f4xx_hal_conf.h index b3ef59aa..ed26bf39 100644 --- a/Firmware/Board/v3/Inc/stm32f4xx_hal_conf.h +++ b/Firmware/Board/v3/Inc/stm32f4xx_hal_conf.h @@ -91,6 +91,7 @@ /* #define HAL_SPDIFRX_MODULE_ENABLED */ /* #define HAL_DFSDM_MODULE_ENABLED */ /* #define HAL_LPTIM_MODULE_ENABLED */ +/* #define HAL_EXTI_MODULE_ENABLED */ #define HAL_GPIO_MODULE_ENABLED #define HAL_DMA_MODULE_ENABLED #define HAL_RCC_MODULE_ENABLED @@ -244,6 +245,10 @@ #include "stm32f4xx_hal_rcc.h" #endif /* HAL_RCC_MODULE_ENABLED */ +#ifdef HAL_EXTI_MODULE_ENABLED + #include "stm32f4xx_hal_exti.h" +#endif /* HAL_EXTI_MODULE_ENABLED */ + #ifdef HAL_GPIO_MODULE_ENABLED #include "stm32f4xx_hal_gpio.h" #endif /* HAL_GPIO_MODULE_ENABLED */ diff --git a/Firmware/Board/v3/Inc/stm32f4xx_it.h b/Firmware/Board/v3/Inc/stm32f4xx_it.h index bed8a253..784a3333 100644 --- a/Firmware/Board/v3/Inc/stm32f4xx_it.h +++ b/Firmware/Board/v3/Inc/stm32f4xx_it.h @@ -54,8 +54,10 @@ void BusFault_Handler(void); void UsageFault_Handler(void); void DebugMon_Handler(void); void SysTick_Handler(void); +void DMA1_Stream0_IRQHandler(void); void DMA1_Stream2_IRQHandler(void); void DMA1_Stream4_IRQHandler(void); +void DMA1_Stream5_IRQHandler(void); void ADC_IRQHandler(void); void CAN1_TX_IRQHandler(void); void CAN1_RX0_IRQHandler(void); @@ -63,6 +65,7 @@ void CAN1_RX1_IRQHandler(void); void CAN1_SCE_IRQHandler(void); void TIM8_TRG_COM_TIM14_IRQHandler(void); void TIM5_IRQHandler(void); +void SPI3_IRQHandler(void); void UART4_IRQHandler(void); void OTG_FS_IRQHandler(void); diff --git a/Firmware/Board/v3/Inc/tim.h b/Firmware/Board/v3/Inc/tim.h index 7006b95a..a4585c53 100644 --- a/Firmware/Board/v3/Inc/tim.h +++ b/Firmware/Board/v3/Inc/tim.h @@ -67,6 +67,7 @@ extern TIM_HandleTypeDef htim3; extern TIM_HandleTypeDef htim4; extern TIM_HandleTypeDef htim5; extern TIM_HandleTypeDef htim8; +extern TIM_HandleTypeDef htim13; /* USER CODE BEGIN Private defines */ @@ -80,10 +81,10 @@ void MX_TIM3_Init(void); void MX_TIM4_Init(void); void MX_TIM5_Init(void); void MX_TIM8_Init(void); - +void MX_TIM13_Init(void); + void HAL_TIM_MspPostInit(TIM_HandleTypeDef *htim); - - + /* USER CODE BEGIN Prototypes */ void OC4_PWM_Override(TIM_HandleTypeDef* htim); diff --git a/Firmware/Board/v3/Inc/usbd_conf.h b/Firmware/Board/v3/Inc/usbd_conf.h index fe7867dd..dbf800b3 100644 --- a/Firmware/Board/v3/Inc/usbd_conf.h +++ b/Firmware/Board/v3/Inc/usbd_conf.h @@ -89,7 +89,7 @@ * @brief Defines for configuration of the Usb device. * @{ */ -#define MS_VendorCode 'P' + #define MS_VendorCode 'P' /*---------- -----------*/ #define USBD_MAX_NUM_INTERFACES 1 diff --git a/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h b/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h index 754be245..89a105dc 100644 --- a/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h +++ b/Firmware/Board/v3/Middlewares/Third_Party/FreeRTOS/Source/CMSIS_RTOS/cmsis_os.h @@ -26,7 +26,7 @@ * *---------------------------------------------------------------------------- * - * Portions Copyright © 2016 STMicroelectronics International N.V. All rights reserved. + * Portions Copyright � 2016 STMicroelectronics International N.V. All rights reserved. * Portions Copyright (c) 2013 ARM LIMITED * All rights reserved. * Redistribution and use in source and binary forms, with or without diff --git a/Firmware/Board/v3/Odrive.ioc b/Firmware/Board/v3/Odrive.ioc index fa9ca5ac..7a334af7 100644 --- a/Firmware/Board/v3/Odrive.ioc +++ b/Firmware/Board/v3/Odrive.ioc @@ -76,9 +76,11 @@ ADC3.SamplingTime-7\#ChannelRegularConversion=ADC_SAMPLETIME_3CYCLES ADC3.SamplingTime-8\#ChannelInjectedConversion=ADC_SAMPLETIME_3CYCLES ADC3.ScanConvMode=DISABLE CAN1.AutoWakeUp=ENABLE -CAN1.CalculateTimeBit=2000 +CAN1.BS1=CAN_BS1_6TQ +CAN1.BS2=CAN_BS2_5TQ +CAN1.CalculateTimeBit=500 CAN1.CalculateTimeQuantum=166.66666666666669 -CAN1.IPParameters=CalculateTimeQuantum,CalculateTimeBit,Prescaler,TimeSeg1,TimeSeg2,AutoWakeUp +CAN1.IPParameters=CalculateTimeQuantum,CalculateTimeBit,Prescaler,TimeSeg1,TimeSeg2,AutoWakeUp,BS1,BS2 CAN1.Prescaler=7 CAN1.TimeSeg1=CAN_BS1_6TQ CAN1.TimeSeg2=CAN_BS2_5TQ @@ -95,7 +97,29 @@ Dma.ADC1.2.RequestParameters=Instance,Direction,PeriphInc,MemInc,PeriphDataAlign Dma.Request0=UART4_RX Dma.Request1=UART4_TX Dma.Request2=ADC1 -Dma.RequestsNb=3 +Dma.Request3=SPI3_TX +Dma.Request4=SPI3_RX +Dma.RequestsNb=5 +Dma.SPI3_RX.4.Direction=DMA_PERIPH_TO_MEMORY +Dma.SPI3_RX.4.FIFOMode=DMA_FIFOMODE_DISABLE +Dma.SPI3_RX.4.Instance=DMA1_Stream0 +Dma.SPI3_RX.4.MemDataAlignment=DMA_MDATAALIGN_HALFWORD +Dma.SPI3_RX.4.MemInc=DMA_MINC_ENABLE +Dma.SPI3_RX.4.Mode=DMA_NORMAL +Dma.SPI3_RX.4.PeriphDataAlignment=DMA_PDATAALIGN_HALFWORD +Dma.SPI3_RX.4.PeriphInc=DMA_PINC_DISABLE +Dma.SPI3_RX.4.Priority=DMA_PRIORITY_MEDIUM +Dma.SPI3_RX.4.RequestParameters=Instance,Direction,PeriphInc,MemInc,PeriphDataAlignment,MemDataAlignment,Mode,Priority,FIFOMode +Dma.SPI3_TX.3.Direction=DMA_MEMORY_TO_PERIPH +Dma.SPI3_TX.3.FIFOMode=DMA_FIFOMODE_DISABLE +Dma.SPI3_TX.3.Instance=DMA1_Stream5 +Dma.SPI3_TX.3.MemDataAlignment=DMA_MDATAALIGN_HALFWORD +Dma.SPI3_TX.3.MemInc=DMA_MINC_ENABLE +Dma.SPI3_TX.3.Mode=DMA_NORMAL +Dma.SPI3_TX.3.PeriphDataAlignment=DMA_PDATAALIGN_HALFWORD +Dma.SPI3_TX.3.PeriphInc=DMA_PINC_DISABLE +Dma.SPI3_TX.3.Priority=DMA_PRIORITY_MEDIUM +Dma.SPI3_TX.3.RequestParameters=Instance,Direction,PeriphInc,MemInc,PeriphDataAlignment,MemDataAlignment,Mode,Priority,FIFOMode Dma.UART4_RX.0.Direction=DMA_PERIPH_TO_MEMORY Dma.UART4_RX.0.FIFOMode=DMA_FIFOMODE_DISABLE Dma.UART4_RX.0.Instance=DMA1_Stream2 @@ -135,9 +159,10 @@ Mcu.IP12=TIM3 Mcu.IP13=TIM4 Mcu.IP14=TIM5 Mcu.IP15=TIM8 -Mcu.IP16=UART4 -Mcu.IP17=USB_DEVICE -Mcu.IP18=USB_OTG_FS +Mcu.IP16=TIM13 +Mcu.IP17=UART4 +Mcu.IP18=USB_DEVICE +Mcu.IP19=USB_OTG_FS Mcu.IP2=ADC3 Mcu.IP3=CAN1 Mcu.IP4=DMA @@ -146,7 +171,7 @@ Mcu.IP6=NVIC Mcu.IP7=RCC Mcu.IP8=SPI3 Mcu.IP9=SYS -Mcu.IPNb=19 +Mcu.IPNb=20 Mcu.Name=STM32F405RGTx Mcu.Package=LQFP64 Mcu.Pin0=PC13-ANTI_TAMP @@ -200,25 +225,28 @@ Mcu.Pin51=VP_FREERTOS_VS_ENABLE Mcu.Pin52=VP_SYS_VS_tim14 Mcu.Pin53=VP_TIM1_VS_ClockSourceINT Mcu.Pin54=VP_TIM1_VS_no_output4 -Mcu.Pin55=VP_USB_DEVICE_VS_USB_DEVICE_CDC_FS +Mcu.Pin55=VP_TIM13_VS_ClockSourceINT +Mcu.Pin56=VP_USB_DEVICE_VS_USB_DEVICE_CDC_FS Mcu.Pin6=PC1 Mcu.Pin7=PC2 Mcu.Pin8=PC3 Mcu.Pin9=PA0-WKUP -Mcu.PinsNb=56 +Mcu.PinsNb=57 Mcu.ThirdPartyNb=0 -Mcu.UserConstants=TIM_1_8_CLOCK_HZ,168000000;TIM_1_8_PERIOD_CLOCKS,10192;TIM_1_8_DEADTIME_CLOCKS,20;TIM_APB1_CLOCK_HZ,84000000;TIM_APB1_PERIOD_CLOCKS,4096;TIM_APB1_DEADTIME_CLOCKS,40;configAPPLICATION_ALLOCATED_HEAP,1 +Mcu.UserConstants=TIM_1_8_CLOCK_HZ,168000000;TIM_1_8_PERIOD_CLOCKS,3500;TIM_1_8_DEADTIME_CLOCKS,20;TIM_APB1_CLOCK_HZ,84000000;TIM_APB1_PERIOD_CLOCKS,4096;TIM_APB1_DEADTIME_CLOCKS,40;TIM_1_8_RCR,2 Mcu.UserName=STM32F405RGTx -MxCube.Version=4.24.0 -MxDb.Version=DB.4.0.240 +MxCube.Version=4.27.0 +MxDb.Version=DB.4.0.270 NVIC.ADC_IRQn=true\:5\:0\:false\:false\:true\:true\:true NVIC.BusFault_IRQn=true\:0\:0\:false\:false\:true\:false\:true NVIC.CAN1_RX0_IRQn=true\:6\:0\:true\:false\:true\:true\:true NVIC.CAN1_RX1_IRQn=true\:6\:0\:true\:false\:true\:true\:true NVIC.CAN1_SCE_IRQn=true\:6\:0\:true\:false\:true\:true\:true NVIC.CAN1_TX_IRQn=true\:6\:0\:true\:false\:true\:true\:true +NVIC.DMA1_Stream0_IRQn=true\:5\:0\:false\:false\:true\:true\:false NVIC.DMA1_Stream2_IRQn=true\:5\:0\:false\:false\:true\:true\:true NVIC.DMA1_Stream4_IRQn=true\:5\:0\:false\:false\:true\:true\:false +NVIC.DMA1_Stream5_IRQn=true\:5\:0\:false\:false\:true\:true\:false NVIC.DMA2_Stream0_IRQn=true\:5\:0\:false\:false\:false\:true\:false NVIC.DebugMonitor_IRQn=true\:0\:0\:false\:false\:true\:false\:true NVIC.HardFault_IRQn=true\:0\:0\:false\:false\:true\:false\:true @@ -227,6 +255,7 @@ NVIC.NonMaskableInt_IRQn=true\:0\:0\:false\:false\:true\:false\:true NVIC.OTG_FS_IRQn=true\:5\:0\:false\:false\:true\:true\:true NVIC.PendSV_IRQn=true\:15\:0\:false\:false\:false\:true\:true NVIC.PriorityGroup=NVIC_PRIORITYGROUP_4 +NVIC.SPI3_IRQn=true\:5\:0\:false\:false\:true\:true\:true NVIC.SVCall_IRQn=true\:0\:0\:false\:false\:false\:false\:true NVIC.SysTick_IRQn=true\:15\:0\:false\:false\:true\:true\:true NVIC.TIM1_UP_TIM10_IRQn=true\:0\:0\:false\:false\:false\:false\:true @@ -443,13 +472,15 @@ ProjectManager.CustomerFirmwarePackage= ProjectManager.DefaultFWLocation=true ProjectManager.DeletePrevious=true ProjectManager.DeviceId=STM32F405RGTx -ProjectManager.FirmwarePackage=STM32Cube FW_F4 V1.19.0 +ProjectManager.FirmwarePackage=STM32Cube FW_F4 V1.21.0 ProjectManager.FreePins=false ProjectManager.HalAssertFull=false ProjectManager.HeapSize=0x3C00 ProjectManager.KeepUserCode=true ProjectManager.LastFirmware=true ProjectManager.LibraryCopy=1 +ProjectManager.MainLocation=Src +ProjectManager.NoMain=false ProjectManager.PreviousToolchain=SW4STM32 ProjectManager.ProjectBuild=false ProjectManager.ProjectFileName=Odrive.ioc @@ -458,7 +489,7 @@ ProjectManager.StackSize=0x800 ProjectManager.TargetToolchain=Makefile ProjectManager.ToolChainLocation= ProjectManager.UnderRoot=false -ProjectManager.functionlistsort=1-MX_GPIO_Init-GPIO-false-HAL-true,2-MX_DMA_Init-DMA-false-HAL-true,3-MX_ADC1_Init-ADC1-false-HAL-true,4-MX_ADC2_Init-ADC2-false-HAL-true,5-MX_CAN1_Init-CAN1-false-HAL-true,6-MX_TIM1_Init-TIM1-false-HAL-true,7-MX_TIM8_Init-TIM8-false-HAL-true,8-MX_TIM3_Init-TIM3-false-HAL-true,9-MX_TIM4_Init-TIM4-false-HAL-true,10-MX_SPI3_Init-SPI3-false-HAL-true,11-MX_ADC3_Init-ADC3-false-HAL-true,12-SystemClock_Config-RCC-false-HAL-true,13-MX_TIM2_Init-TIM2-false-HAL-true,14-MX_USB_DEVICE_Init-USB_DEVICE-false-HAL-true,15-MX_UART4_Init-UART4-false-HAL-true,16-MX_TIM5_Init-TIM5-false-HAL-true +ProjectManager.functionlistsort=1-MX_GPIO_Init-GPIO-false-HAL-true,2-MX_DMA_Init-DMA-false-HAL-true,3-MX_ADC1_Init-ADC1-false-HAL-true,4-MX_ADC2_Init-ADC2-false-HAL-true,5-MX_CAN1_Init-CAN1-false-HAL-true,6-MX_TIM1_Init-TIM1-false-HAL-true,7-MX_TIM8_Init-TIM8-false-HAL-true,8-MX_TIM3_Init-TIM3-false-HAL-true,9-MX_TIM4_Init-TIM4-false-HAL-true,10-MX_SPI3_Init-SPI3-false-HAL-true,11-MX_ADC3_Init-ADC3-false-HAL-true,12-SystemClock_Config-RCC-false-HAL-true,13-MX_TIM2_Init-TIM2-false-HAL-true,14-MX_USB_DEVICE_Init-USB_DEVICE-false-HAL-true,15-MX_UART4_Init-UART4-false-HAL-true,16-MX_TIM5_Init-TIM5-false-HAL-true,17-MX_TIM13_Init-TIM13-false-HAL-true RCC.48MHZClocksFreq_Value=48000000 RCC.AHBFreq_Value=168000000 RCC.APB1CLKDivider=RCC_HCLK_DIV4 @@ -576,7 +607,7 @@ TIM1.Channel-PWM\ Generation2\ CH2\ CH2N=TIM_CHANNEL_2 TIM1.Channel-PWM\ Generation3\ CH3\ CH3N=TIM_CHANNEL_3 TIM1.CounterMode=TIM_COUNTERMODE_CENTERALIGNED3 TIM1.DeadTime=TIM_1_8_DEADTIME_CLOCKS -TIM1.IPParameters=Channel-PWM Generation2 CH2 CH2N,Channel-PWM Generation3 CH3 CH3N,OCNPolarity_1,OCNPolarity_2,OCNPolarity_3,CounterMode,OCMode_PWM-PWM Generation1 CH1 CH1N,OCMode_PWM-PWM Generation2 CH2 CH2N,OCMode_PWM-PWM Generation3 CH3 CH3N,Period,DeadTime,OffStateRunMode,OffStateIDLEMode,Channel-Output Compare4 No Output,TIM_MasterOutputTrigger,Channel-PWM Generation1 CH1 CH1N +TIM1.IPParameters=Channel-PWM Generation2 CH2 CH2N,Channel-PWM Generation3 CH3 CH3N,OCNPolarity_1,OCNPolarity_2,OCNPolarity_3,CounterMode,OCMode_PWM-PWM Generation1 CH1 CH1N,OCMode_PWM-PWM Generation2 CH2 CH2N,OCMode_PWM-PWM Generation3 CH3 CH3N,Period,DeadTime,OffStateRunMode,OffStateIDLEMode,Channel-Output Compare4 No Output,TIM_MasterOutputTrigger,Channel-PWM Generation1 CH1 CH1N,RepetitionCounter TIM1.OCMode_PWM-PWM\ Generation1\ CH1\ CH1N=TIM_OCMODE_PWM2 TIM1.OCMode_PWM-PWM\ Generation2\ CH2\ CH2N=TIM_OCMODE_PWM2 TIM1.OCMode_PWM-PWM\ Generation3\ CH3\ CH3N=TIM_OCMODE_PWM2 @@ -586,7 +617,10 @@ TIM1.OCNPolarity_3=TIM_OCNPOLARITY_HIGH TIM1.OffStateIDLEMode=TIM_OSSI_ENABLE TIM1.OffStateRunMode=TIM_OSSR_ENABLE TIM1.Period=TIM_1_8_PERIOD_CLOCKS +TIM1.RepetitionCounter=TIM_1_8_RCR TIM1.TIM_MasterOutputTrigger=TIM_TRGO_UPDATE +TIM13.IPParameters=Period +TIM13.Period=(2 * TIM_1_8_PERIOD_CLOCKS * (TIM_1_8_RCR+1)) * (TIM_APB1_CLOCK_HZ / TIM_1_8_CLOCK_HZ) TIM2.Channel-PWM\ Generation3\ CH3=TIM_CHANNEL_3 TIM2.Channel-PWM\ Generation4\ CH4=TIM_CHANNEL_4 TIM2.CounterMode=TIM_COUNTERMODE_CENTERALIGNED3 @@ -624,13 +658,14 @@ TIM8.Channel-PWM\ Generation2\ CH2\ CH2N=TIM_CHANNEL_2 TIM8.Channel-PWM\ Generation3\ CH3\ CH3N=TIM_CHANNEL_3 TIM8.CounterMode=TIM_COUNTERMODE_CENTERALIGNED3 TIM8.DeadTime=TIM_1_8_DEADTIME_CLOCKS -TIM8.IPParameters=Channel-PWM Generation3 CH3 CH3N,Channel-PWM Generation2 CH2 CH2N,CounterMode,Period,OffStateRunMode,OffStateIDLEMode,DeadTime,OCMode_PWM-PWM Generation1 CH1 CH1N,OCMode_PWM-PWM Generation2 CH2 CH2N,OCMode_PWM-PWM Generation3 CH3 CH3N,Channel-Output Compare4 No Output,TIM_MasterOutputTrigger,Channel-PWM Generation1 CH1 CH1N +TIM8.IPParameters=Channel-PWM Generation3 CH3 CH3N,Channel-PWM Generation2 CH2 CH2N,CounterMode,Period,OffStateRunMode,OffStateIDLEMode,DeadTime,OCMode_PWM-PWM Generation1 CH1 CH1N,OCMode_PWM-PWM Generation2 CH2 CH2N,OCMode_PWM-PWM Generation3 CH3 CH3N,Channel-Output Compare4 No Output,TIM_MasterOutputTrigger,Channel-PWM Generation1 CH1 CH1N,RepetitionCounter TIM8.OCMode_PWM-PWM\ Generation1\ CH1\ CH1N=TIM_OCMODE_PWM2 TIM8.OCMode_PWM-PWM\ Generation2\ CH2\ CH2N=TIM_OCMODE_PWM2 TIM8.OCMode_PWM-PWM\ Generation3\ CH3\ CH3N=TIM_OCMODE_PWM2 TIM8.OffStateIDLEMode=TIM_OSSI_ENABLE TIM8.OffStateRunMode=TIM_OSSR_ENABLE TIM8.Period=TIM_1_8_PERIOD_CLOCKS +TIM8.RepetitionCounter=TIM_1_8_RCR TIM8.TIM_MasterOutputTrigger=TIM_TRGO_UPDATE UART4.IPParameters=VirtualMode UART4.VirtualMode=Asynchronous @@ -652,6 +687,8 @@ VP_FREERTOS_VS_ENABLE.Mode=Enabled VP_FREERTOS_VS_ENABLE.Signal=FREERTOS_VS_ENABLE VP_SYS_VS_tim14.Mode=TIM14 VP_SYS_VS_tim14.Signal=SYS_VS_tim14 +VP_TIM13_VS_ClockSourceINT.Mode=Enable_Timer +VP_TIM13_VS_ClockSourceINT.Signal=TIM13_VS_ClockSourceINT VP_TIM1_VS_ClockSourceINT.Mode=Internal VP_TIM1_VS_ClockSourceINT.Signal=TIM1_VS_ClockSourceINT VP_TIM1_VS_no_output4.Mode=Output Compare4 No Output diff --git a/Firmware/Board/v3/STM32F405RGTx_FLASH.ld b/Firmware/Board/v3/STM32F405RGTx_FLASH.ld index 30acca2c..f1259a71 100644 --- a/Firmware/Board/v3/STM32F405RGTx_FLASH.ld +++ b/Firmware/Board/v3/STM32F405RGTx_FLASH.ld @@ -134,9 +134,10 @@ SECTIONS * * IMPORTANT NOTE! * If initialized variables will be placed in this section, - * the startup code needs to be modified to copy the init-values. + * the startup code needs to be modified to copy the init-values. + * Oskar: Added NOLOAD to remove this section from .bin outputs */ - .ccmram : + .ccmram (NOLOAD): { . = ALIGN(4); _sccmram = .; /* create a global symbol at ccmram start */ diff --git a/Firmware/Board/v3/Src/dma.c b/Firmware/Board/v3/Src/dma.c index 3de873ad..813c735a 100644 --- a/Firmware/Board/v3/Src/dma.c +++ b/Firmware/Board/v3/Src/dma.c @@ -71,12 +71,18 @@ void MX_DMA_Init(void) __HAL_RCC_DMA2_CLK_ENABLE(); /* DMA interrupt init */ + /* DMA1_Stream0_IRQn interrupt configuration */ + HAL_NVIC_SetPriority(DMA1_Stream0_IRQn, 5, 0); + HAL_NVIC_EnableIRQ(DMA1_Stream0_IRQn); /* DMA1_Stream2_IRQn interrupt configuration */ HAL_NVIC_SetPriority(DMA1_Stream2_IRQn, 5, 0); HAL_NVIC_EnableIRQ(DMA1_Stream2_IRQn); /* DMA1_Stream4_IRQn interrupt configuration */ HAL_NVIC_SetPriority(DMA1_Stream4_IRQn, 5, 0); HAL_NVIC_EnableIRQ(DMA1_Stream4_IRQn); + /* DMA1_Stream5_IRQn interrupt configuration */ + HAL_NVIC_SetPriority(DMA1_Stream5_IRQn, 5, 0); + HAL_NVIC_EnableIRQ(DMA1_Stream5_IRQn); /* DMA2_Stream0_IRQn interrupt configuration */ // Dear STM, no we _don't_ want to fire an interrupt for this DMA // (it's not possible to deselect this in CubeMX) diff --git a/Firmware/Board/v3/Src/freertos.c b/Firmware/Board/v3/Src/freertos.c index 524cd6cb..11154587 100644 --- a/Firmware/Board/v3/Src/freertos.c +++ b/Firmware/Board/v3/Src/freertos.c @@ -1,3 +1,4 @@ +/* USER CODE BEGIN Header */ /** ****************************************************************************** * File Name : freertos.c @@ -45,12 +46,15 @@ * ****************************************************************************** */ +/* USER CODE END Header */ /* Includes ------------------------------------------------------------------*/ #include "FreeRTOS.h" #include "task.h" +#include "main.h" #include "cmsis_os.h" +/* Private includes ----------------------------------------------------------*/ /* USER CODE BEGIN Includes */ #include "freertos_vars.h" #include "usb_device.h" @@ -58,9 +62,22 @@ extern PCD_HandleTypeDef hpcd_USB_OTG_FS; int odrive_main(void); /* USER CODE END Includes */ -/* Variables -----------------------------------------------------------------*/ -osThreadId defaultTaskHandle; +/* Private typedef -----------------------------------------------------------*/ +/* USER CODE BEGIN PTD */ +/* USER CODE END PTD */ + +/* Private define ------------------------------------------------------------*/ +/* USER CODE BEGIN PD */ + +/* USER CODE END PD */ + +/* Private macro -------------------------------------------------------------*/ +/* USER CODE BEGIN PM */ + +/* USER CODE END PM */ + +/* Private variables ---------------------------------------------------------*/ /* USER CODE BEGIN Variables */ // List of semaphores osSemaphoreId sem_usb_irq; @@ -74,17 +91,18 @@ osThreadId usb_irq_thread; __attribute__((section(".ccmram"))) uint8_t ucHeap[configTOTAL_HEAP_SIZE]; /* USER CODE END Variables */ +osThreadId defaultTaskHandle; + +/* Private function prototypes -----------------------------------------------*/ +/* USER CODE BEGIN FunctionPrototypes */ + +/* USER CODE END FunctionPrototypes */ -/* Function prototypes -------------------------------------------------------*/ void StartDefaultTask(void * argument); extern void MX_USB_DEVICE_Init(void); void MX_FREERTOS_Init(void); /* (MISRA C 2004 rule 8.1) */ -/* USER CODE BEGIN FunctionPrototypes */ - -/* USER CODE END FunctionPrototypes */ - /* Hook prototypes */ void vApplicationIdleHook(void); void vApplicationStackOverflowHook(xTaskHandle xTask, signed char *pcTaskName); @@ -135,8 +153,11 @@ void init_deferred_interrupts(void) { /* USER CODE END 4 */ -/* Init FreeRTOS */ - +/** + * @brief FreeRTOS initialization + * @param None + * @retval None + */ void MX_FREERTOS_Init(void) { /* USER CODE BEGIN Init */ @@ -186,7 +207,13 @@ void MX_FREERTOS_Init(void) { /* USER CODE END RTOS_QUEUES */ } -/* StartDefaultTask function */ +/* USER CODE BEGIN Header_StartDefaultTask */ +/** + * @brief Function implementing the defaultTask thread. + * @param argument: Not used + * @retval None + */ +/* USER CODE END Header_StartDefaultTask */ void StartDefaultTask(void * argument) { /* init code for USB_DEVICE */ @@ -202,6 +229,7 @@ void StartDefaultTask(void * argument) /* USER CODE END StartDefaultTask */ } +/* Private application code --------------------------------------------------*/ /* USER CODE BEGIN Application */ /* USER CODE END Application */ diff --git a/Firmware/Board/v3/Src/main.c b/Firmware/Board/v3/Src/main.c index b71d6416..154c98af 100644 --- a/Firmware/Board/v3/Src/main.c +++ b/Firmware/Board/v3/Src/main.c @@ -1,3 +1,4 @@ + /** ****************************************************************************** * @file : main.c @@ -179,7 +180,7 @@ int main(void) MX_DMA_Init(); MX_ADC1_Init(); MX_ADC2_Init(); - MX_CAN1_Init(); + // MX_CAN1_Init(); // CAN or I2C called in main.cpp instead MX_TIM1_Init(); MX_TIM8_Init(); MX_TIM3_Init(); @@ -189,6 +190,7 @@ int main(void) MX_TIM2_Init(); MX_UART4_Init(); MX_TIM5_Init(); + MX_TIM13_Init(); /* USER CODE BEGIN 2 */ //Required to use OC4 for ADC triggering. diff --git a/Firmware/Board/v3/Src/spi.c b/Firmware/Board/v3/Src/spi.c index 87b2a018..d66515f9 100644 --- a/Firmware/Board/v3/Src/spi.c +++ b/Firmware/Board/v3/Src/spi.c @@ -51,12 +51,15 @@ #include "spi.h" #include "gpio.h" +#include "dma.h" /* USER CODE BEGIN 0 */ /* USER CODE END 0 */ SPI_HandleTypeDef hspi3; +DMA_HandleTypeDef hdma_spi3_tx; +DMA_HandleTypeDef hdma_spi3_rx; /* SPI3 init function */ void MX_SPI3_Init(void) @@ -105,6 +108,46 @@ void HAL_SPI_MspInit(SPI_HandleTypeDef* spiHandle) GPIO_InitStruct.Alternate = GPIO_AF6_SPI3; HAL_GPIO_Init(GPIOC, &GPIO_InitStruct); + /* SPI3 DMA Init */ + /* SPI3_TX Init */ + hdma_spi3_tx.Instance = DMA1_Stream5; + hdma_spi3_tx.Init.Channel = DMA_CHANNEL_0; + hdma_spi3_tx.Init.Direction = DMA_MEMORY_TO_PERIPH; + hdma_spi3_tx.Init.PeriphInc = DMA_PINC_DISABLE; + hdma_spi3_tx.Init.MemInc = DMA_MINC_ENABLE; + hdma_spi3_tx.Init.PeriphDataAlignment = DMA_PDATAALIGN_HALFWORD; + hdma_spi3_tx.Init.MemDataAlignment = DMA_MDATAALIGN_HALFWORD; + hdma_spi3_tx.Init.Mode = DMA_NORMAL; + hdma_spi3_tx.Init.Priority = DMA_PRIORITY_MEDIUM; + hdma_spi3_tx.Init.FIFOMode = DMA_FIFOMODE_DISABLE; + if (HAL_DMA_Init(&hdma_spi3_tx) != HAL_OK) + { + _Error_Handler(__FILE__, __LINE__); + } + + __HAL_LINKDMA(spiHandle,hdmatx,hdma_spi3_tx); + + /* SPI3_RX Init */ + hdma_spi3_rx.Instance = DMA1_Stream0; + hdma_spi3_rx.Init.Channel = DMA_CHANNEL_0; + hdma_spi3_rx.Init.Direction = DMA_PERIPH_TO_MEMORY; + hdma_spi3_rx.Init.PeriphInc = DMA_PINC_DISABLE; + hdma_spi3_rx.Init.MemInc = DMA_MINC_ENABLE; + hdma_spi3_rx.Init.PeriphDataAlignment = DMA_PDATAALIGN_HALFWORD; + hdma_spi3_rx.Init.MemDataAlignment = DMA_MDATAALIGN_HALFWORD; + hdma_spi3_rx.Init.Mode = DMA_NORMAL; + hdma_spi3_rx.Init.Priority = DMA_PRIORITY_MEDIUM; + hdma_spi3_rx.Init.FIFOMode = DMA_FIFOMODE_DISABLE; + if (HAL_DMA_Init(&hdma_spi3_rx) != HAL_OK) + { + _Error_Handler(__FILE__, __LINE__); + } + + __HAL_LINKDMA(spiHandle,hdmarx,hdma_spi3_rx); + + /* SPI3 interrupt Init */ + HAL_NVIC_SetPriority(SPI3_IRQn, 5, 0); + HAL_NVIC_EnableIRQ(SPI3_IRQn); /* USER CODE BEGIN SPI3_MspInit 1 */ /* USER CODE END SPI3_MspInit 1 */ @@ -129,6 +172,12 @@ void HAL_SPI_MspDeInit(SPI_HandleTypeDef* spiHandle) */ HAL_GPIO_DeInit(GPIOC, GPIO_PIN_10|GPIO_PIN_11|GPIO_PIN_12); + /* SPI3 DMA DeInit */ + HAL_DMA_DeInit(spiHandle->hdmatx); + HAL_DMA_DeInit(spiHandle->hdmarx); + + /* SPI3 interrupt Deinit */ + HAL_NVIC_DisableIRQ(SPI3_IRQn); /* USER CODE BEGIN SPI3_MspDeInit 1 */ /* USER CODE END SPI3_MspDeInit 1 */ diff --git a/Firmware/Board/v3/Src/stm32f4xx_hal_msp.c b/Firmware/Board/v3/Src/stm32f4xx_hal_msp.c index fac7e341..e49480c0 100644 --- a/Firmware/Board/v3/Src/stm32f4xx_hal_msp.c +++ b/Firmware/Board/v3/Src/stm32f4xx_hal_msp.c @@ -48,7 +48,6 @@ */ /* Includes ------------------------------------------------------------------*/ #include "stm32f4xx_hal.h" - extern void _Error_Handler(char *, int); /* USER CODE BEGIN 0 */ @@ -62,6 +61,9 @@ void HAL_MspInit(void) /* USER CODE END MspInit 0 */ + __HAL_RCC_SYSCFG_CLK_ENABLE(); + __HAL_RCC_PWR_CLK_ENABLE(); + HAL_NVIC_SetPriorityGrouping(NVIC_PRIORITYGROUP_4); /* System interrupt init*/ diff --git a/Firmware/Board/v3/Src/stm32f4xx_it.c b/Firmware/Board/v3/Src/stm32f4xx_it.c index 7ee8eecb..7746ae87 100644 --- a/Firmware/Board/v3/Src/stm32f4xx_it.c +++ b/Firmware/Board/v3/Src/stm32f4xx_it.c @@ -63,6 +63,9 @@ extern ADC_HandleTypeDef hadc1; extern ADC_HandleTypeDef hadc2; extern ADC_HandleTypeDef hadc3; extern CAN_HandleTypeDef hcan1; +extern DMA_HandleTypeDef hdma_spi3_tx; +extern DMA_HandleTypeDef hdma_spi3_rx; +extern SPI_HandleTypeDef hspi3; extern TIM_HandleTypeDef htim5; extern TIM_HandleTypeDef htim8; extern DMA_HandleTypeDef hdma_uart4_rx; @@ -206,6 +209,20 @@ void SysTick_Handler(void) /* please refer to the startup file (startup_stm32f4xx.s). */ /******************************************************************************/ +/** +* @brief This function handles DMA1 stream0 global interrupt. +*/ +void DMA1_Stream0_IRQHandler(void) +{ + /* USER CODE BEGIN DMA1_Stream0_IRQn 0 */ + + /* USER CODE END DMA1_Stream0_IRQn 0 */ + HAL_DMA_IRQHandler(&hdma_spi3_rx); + /* USER CODE BEGIN DMA1_Stream0_IRQn 1 */ + + /* USER CODE END DMA1_Stream0_IRQn 1 */ +} + /** * @brief This function handles DMA1 stream2 global interrupt. */ @@ -234,6 +251,20 @@ void DMA1_Stream4_IRQHandler(void) /* USER CODE END DMA1_Stream4_IRQn 1 */ } +/** +* @brief This function handles DMA1 stream5 global interrupt. +*/ +void DMA1_Stream5_IRQHandler(void) +{ + /* USER CODE BEGIN DMA1_Stream5_IRQn 0 */ + + /* USER CODE END DMA1_Stream5_IRQn 0 */ + HAL_DMA_IRQHandler(&hdma_spi3_tx); + /* USER CODE BEGIN DMA1_Stream5_IRQn 1 */ + + /* USER CODE END DMA1_Stream5_IRQn 1 */ +} + /** * @brief This function handles ADC1, ADC2 and ADC3 global interrupts. */ @@ -348,6 +379,20 @@ void TIM5_IRQHandler(void) /* USER CODE END TIM5_IRQn 1 */ } +/** +* @brief This function handles SPI3 global interrupt. +*/ +void SPI3_IRQHandler(void) +{ + /* USER CODE BEGIN SPI3_IRQn 0 */ + + /* USER CODE END SPI3_IRQn 0 */ + HAL_SPI_IRQHandler(&hspi3); + /* USER CODE BEGIN SPI3_IRQn 1 */ + + /* USER CODE END SPI3_IRQn 1 */ +} + /** * @brief This function handles UART4 global interrupt. */ diff --git a/Firmware/Board/v3/Src/tim.c b/Firmware/Board/v3/Src/tim.c index 7b159ea5..97205c15 100644 --- a/Firmware/Board/v3/Src/tim.c +++ b/Firmware/Board/v3/Src/tim.c @@ -80,6 +80,7 @@ TIM_HandleTypeDef htim3; TIM_HandleTypeDef htim4; TIM_HandleTypeDef htim5; TIM_HandleTypeDef htim8; +TIM_HandleTypeDef htim13; /* TIM1 init function */ void MX_TIM1_Init(void) @@ -94,7 +95,7 @@ void MX_TIM1_Init(void) htim1.Init.CounterMode = TIM_COUNTERMODE_CENTERALIGNED3; htim1.Init.Period = TIM_1_8_PERIOD_CLOCKS; htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; - htim1.Init.RepetitionCounter = 0; + htim1.Init.RepetitionCounter = TIM_1_8_RCR; if (HAL_TIM_Base_Init(&htim1) != HAL_OK) { _Error_Handler(__FILE__, __LINE__); @@ -324,7 +325,7 @@ void MX_TIM8_Init(void) htim8.Init.CounterMode = TIM_COUNTERMODE_CENTERALIGNED3; htim8.Init.Period = TIM_1_8_PERIOD_CLOCKS; htim8.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; - htim8.Init.RepetitionCounter = 0; + htim8.Init.RepetitionCounter = TIM_1_8_RCR; if (HAL_TIM_PWM_Init(&htim8) != HAL_OK) { _Error_Handler(__FILE__, __LINE__); @@ -373,6 +374,21 @@ void MX_TIM8_Init(void) HAL_TIM_MspPostInit(&htim8); +} +/* TIM13 init function */ +void MX_TIM13_Init(void) +{ + + htim13.Instance = TIM13; + htim13.Init.Prescaler = 0; + htim13.Init.CounterMode = TIM_COUNTERMODE_UP; + htim13.Init.Period = (2 * TIM_1_8_PERIOD_CLOCKS * (TIM_1_8_RCR+1)) * ((float)TIM_APB1_CLOCK_HZ / (float)TIM_1_8_CLOCK_HZ) - 1; + htim13.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; + if (HAL_TIM_Base_Init(&htim13) != HAL_OK) + { + _Error_Handler(__FILE__, __LINE__); + } + } void HAL_TIM_Base_MspInit(TIM_HandleTypeDef* tim_baseHandle) @@ -393,6 +409,21 @@ void HAL_TIM_Base_MspInit(TIM_HandleTypeDef* tim_baseHandle) /* USER CODE END TIM1_MspInit 1 */ } + else if(tim_baseHandle->Instance==TIM13) + { + /* USER CODE BEGIN TIM13_MspInit 0 */ + + /* USER CODE END TIM13_MspInit 0 */ + /* TIM13 clock enable */ + __HAL_RCC_TIM13_CLK_ENABLE(); + + /* TIM13 interrupt Init */ + HAL_NVIC_SetPriority(TIM8_UP_TIM13_IRQn, 0, 0); + HAL_NVIC_EnableIRQ(TIM8_UP_TIM13_IRQn); + /* USER CODE BEGIN TIM13_MspInit 1 */ + + /* USER CODE END TIM13_MspInit 1 */ + } } void HAL_TIM_PWM_MspInit(TIM_HandleTypeDef* tim_pwmHandle) @@ -626,6 +657,27 @@ void HAL_TIM_Base_MspDeInit(TIM_HandleTypeDef* tim_baseHandle) /* USER CODE END TIM1_MspDeInit 1 */ } + else if(tim_baseHandle->Instance==TIM13) + { + /* USER CODE BEGIN TIM13_MspDeInit 0 */ + + /* USER CODE END TIM13_MspDeInit 0 */ + /* Peripheral clock disable */ + __HAL_RCC_TIM13_CLK_DISABLE(); + + /* TIM13 interrupt Deinit */ + /* USER CODE BEGIN TIM13:TIM8_UP_TIM13_IRQn disable */ + /** + * Uncomment the line below to disable the "TIM8_UP_TIM13_IRQn" interrupt + * Be aware, disabling shared interrupt may affect other IPs + */ + /* HAL_NVIC_DisableIRQ(TIM8_UP_TIM13_IRQn); */ + /* USER CODE END TIM13:TIM8_UP_TIM13_IRQn disable */ + + /* USER CODE BEGIN TIM13_MspDeInit 1 */ + + /* USER CODE END TIM13_MspDeInit 1 */ + } } void HAL_TIM_PWM_MspDeInit(TIM_HandleTypeDef* tim_pwmHandle) @@ -651,7 +703,14 @@ void HAL_TIM_PWM_MspDeInit(TIM_HandleTypeDef* tim_pwmHandle) __HAL_RCC_TIM8_CLK_DISABLE(); /* TIM8 interrupt Deinit */ - HAL_NVIC_DisableIRQ(TIM8_UP_TIM13_IRQn); + /* USER CODE BEGIN TIM8:TIM8_UP_TIM13_IRQn disable */ + /** + * Uncomment the line below to disable the "TIM8_UP_TIM13_IRQn" interrupt + * Be aware, disabling shared interrupt may affect other IPs + */ + /* HAL_NVIC_DisableIRQ(TIM8_UP_TIM13_IRQn); */ + /* USER CODE END TIM8:TIM8_UP_TIM13_IRQn disable */ + HAL_NVIC_DisableIRQ(TIM8_TRG_COM_TIM14_IRQn); /* USER CODE BEGIN TIM8_MspDeInit 1 */ diff --git a/Firmware/Board/v3/Src/usart.c b/Firmware/Board/v3/Src/usart.c index 52a869db..0c4bed6f 100644 --- a/Firmware/Board/v3/Src/usart.c +++ b/Firmware/Board/v3/Src/usart.c @@ -66,7 +66,7 @@ void MX_UART4_Init(void) { huart4.Instance = UART4; - huart4.Init.BaudRate = 115200; + huart4.Init.BaudRate = 115200; // Provisionally this can be changed to 921600 for faster transfers, the low power Arduinos will not keep up. huart4.Init.WordLength = UART_WORDLENGTH_8B; huart4.Init.StopBits = UART_STOPBITS_1; huart4.Init.Parity = UART_PARITY_NONE; diff --git a/Firmware/MotorControl/axis.cpp b/Firmware/MotorControl/axis.cpp index 457d0279..68edf0fb 100644 --- a/Firmware/MotorControl/axis.cpp +++ b/Firmware/MotorControl/axis.cpp @@ -26,6 +26,8 @@ Axis::Axis(const AxisHardwareConfig_t& hw_config, controller_.axis_ = this; motor_.axis_ = this; trap_.axis_ = this; + + decode_step_dir_pins(); } static void step_cb_wrapper(void* ctx) { @@ -66,33 +68,46 @@ bool Axis::wait_for_current_meas() { // step/direction interface void Axis::step_cb() { - if (enable_step_dir_) { - GPIO_PinState dir_pin = HAL_GPIO_ReadPin(hw_config_.dir_port, hw_config_.dir_pin); + if (step_dir_active_) { + GPIO_PinState dir_pin = HAL_GPIO_ReadPin(dir_port_, dir_pin_); float dir = (dir_pin == GPIO_PIN_SET) ? 1.0f : -1.0f; controller_.pos_setpoint_ += dir * config_.counts_per_step; } }; -// @brief Enables or disables step/dir input -void Axis::set_step_dir_enabled(bool enable) { - if (enable) { +void Axis::load_default_step_dir_pin_config( + const AxisHardwareConfig_t& hw_config, Config_t* config) { + config->step_gpio_pin = hw_config.step_gpio_pin; + config->dir_gpio_pin = hw_config.dir_gpio_pin; +} + +void Axis::decode_step_dir_pins() { + step_port_ = get_gpio_port_by_pin(config_.step_gpio_pin); + step_pin_ = get_gpio_pin_by_pin(config_.step_gpio_pin); + dir_port_ = get_gpio_port_by_pin(config_.dir_gpio_pin); + dir_pin_ = get_gpio_pin_by_pin(config_.dir_gpio_pin); +} + +// @brief (de)activates step/dir input +void Axis::set_step_dir_active(bool active) { + if (active) { // Set up the direction GPIO as input GPIO_InitTypeDef GPIO_InitStruct; - GPIO_InitStruct.Pin = hw_config_.dir_pin; + GPIO_InitStruct.Pin = dir_pin_; GPIO_InitStruct.Mode = GPIO_MODE_INPUT; GPIO_InitStruct.Pull = GPIO_NOPULL; - HAL_GPIO_Init(hw_config_.dir_port, &GPIO_InitStruct); + HAL_GPIO_Init(dir_port_, &GPIO_InitStruct); // Subscribe to rising edges of the step GPIO - GPIO_subscribe(hw_config_.step_port, hw_config_.step_pin, GPIO_PULLDOWN, + GPIO_subscribe(step_port_, step_pin_, GPIO_PULLDOWN, step_cb_wrapper, this); - enable_step_dir_ = true; + step_dir_active_ = true; } else { - enable_step_dir_ = false; + step_dir_active_ = false; // Unsubscribe from step GPIO - GPIO_unsubscribe(hw_config_.step_port, hw_config_.step_pin); + GPIO_unsubscribe(step_port_, step_pin_); } } @@ -126,12 +141,6 @@ bool Axis::do_updates() { return check_for_errors(); } -float Axis::get_temp() { - float adc = adc_measurements_[hw_config_.thermistor_adc_ch]; - float normalized_voltage = adc / adc_full_scale; - return horner_fma(normalized_voltage, thermistor_poly_coeffs, thermistor_num_coeffs); -} - bool Axis::run_lockin_spin() { // Spiral up current for softer rotor lock-in lockin_state_ = LOCKIN_STATE_RAMP; @@ -140,7 +149,7 @@ bool Axis::run_lockin_spin() { float phase = wrap_pm_pi(config_.lockin_ramp_distance * x); float I_mag = config_.lockin_current * x; x += current_meas_period / config_.lockin_ramp_time; - if (!motor_.update(I_mag, phase)) + if (!motor_.update(I_mag, phase, 0.0f)) return false; return x < 1.0f; }); @@ -169,7 +178,7 @@ bool Axis::run_lockin_spin() { distance += vel * current_meas_period; phase = wrap_pm_pi(phase + vel * current_meas_period); - if (!motor_.update(config_.lockin_current, phase)) + if (!motor_.update(config_.lockin_current, phase, vel)) return false; return !spin_done(true); //vel_override to go to next phase }); @@ -194,7 +203,6 @@ bool Axis::run_lockin_spin() { // Note run_sensorless_control_loop and run_closed_loop_control_loop are very similar and differ only in where we get the estimate from. bool Axis::run_sensorless_control_loop() { - set_step_dir_enabled(config_.enable_step_dir); run_control_loop([this](){ if (controller_.config_.control_mode >= Controller::CTRL_MODE_POSITION_CONTROL) return error_ |= ERROR_POS_CTRL_DURING_SENSORLESS, false; @@ -203,26 +211,28 @@ bool Axis::run_sensorless_control_loop() { float current_setpoint; if (!controller_.update(sensorless_estimator_.pll_pos_, sensorless_estimator_.vel_estimate_, ¤t_setpoint)) return error_ |= ERROR_CONTROLLER_FAILED, false; - if (!motor_.update(current_setpoint, sensorless_estimator_.phase_)) + if (!motor_.update(current_setpoint, sensorless_estimator_.phase_, sensorless_estimator_.vel_estimate_)) return false; // set_error should update axis.error_ return true; }); - set_step_dir_enabled(false); return check_for_errors(); } bool Axis::run_closed_loop_control_loop() { - set_step_dir_enabled(config_.enable_step_dir); + // To avoid any transient on startup, we intialize the setpoint to be the current position + controller_.pos_setpoint_ = encoder_.pos_estimate_; + set_step_dir_active(config_.enable_step_dir); run_control_loop([this](){ // Note that all estimators are updated in the loop prefix in run_control_loop float current_setpoint; if (!controller_.update(encoder_.pos_estimate_, encoder_.vel_estimate_, ¤t_setpoint)) return error_ |= ERROR_CONTROLLER_FAILED, false; //TODO: Make controller.set_error - if (!motor_.update(current_setpoint, encoder_.phase_)) + float phase_vel = 2*M_PI * encoder_.vel_estimate_ / (float)encoder_.config_.cpr * motor_.config_.pole_pairs; + if (!motor_.update(current_setpoint, encoder_.phase_, phase_vel)) return false; // set_error should update axis.error_ return true; }); - set_step_dir_enabled(false); + set_step_dir_active(false); return check_for_errors(); } diff --git a/Firmware/MotorControl/axis.hpp b/Firmware/MotorControl/axis.hpp index 3d89d3a0..ac1ffb3b 100644 --- a/Firmware/MotorControl/axis.hpp +++ b/Firmware/MotorControl/axis.hpp @@ -45,9 +45,12 @@ public: bool startup_sensorless_control = false; //(ctx)->decode_step_dir_pins(); }, this), + make_protocol_property("dir_gpio_pin", &config_.dir_gpio_pin, + [](void* ctx) { static_cast(ctx)->decode_step_dir_pins(); }, this) ), - make_protocol_function("get_temp", *this, &Axis::get_temp), make_protocol_object("motor", motor_.make_protocol_definitions()), make_protocol_object("controller", controller_.make_protocol_definitions()), make_protocol_object("encoder", encoder_.make_protocol_definitions()), diff --git a/Firmware/MotorControl/board_config_v3.h b/Firmware/MotorControl/board_config_v3.h index 1e170fed..58a8b3e2 100644 --- a/Firmware/MotorControl/board_config_v3.h +++ b/Firmware/MotorControl/board_config_v3.h @@ -21,11 +21,8 @@ typedef struct { - GPIO_TypeDef* step_port; - uint16_t step_pin; - GPIO_TypeDef* dir_port; - uint16_t dir_pin; - size_t thermistor_adc_ch; + uint16_t step_gpio_pin; + uint16_t dir_gpio_pin; osPriority thread_priority; } AxisHardwareConfig_t; @@ -44,6 +41,7 @@ typedef struct { TIM_HandleTypeDef* timer; uint16_t control_deadline; float shunt_conductance; + size_t inverter_thermistor_adc_ch; } MotorHardwareConfig_t; typedef struct { SPI_HandleTypeDef* spi; @@ -68,17 +66,14 @@ extern const size_t thermistor_num_coeffs; //TODO stick this in a C file #ifdef __MAIN_CPP__ const float thermistor_poly_coeffs[] = - {363.0172658f, -459.19773008f, 308.29273921f, -28.12731452f}; + {363.93910201f, -462.15369634f, 307.55129571f, -27.72569531f}; const size_t thermistor_num_coeffs = sizeof(thermistor_poly_coeffs)/sizeof(thermistor_poly_coeffs[1]); const BoardHardwareConfig_t hw_configs[2] = { { //M0 .axis_config = { - .step_port = GPIO_1_GPIO_Port, - .step_pin = GPIO_1_Pin, - .dir_port = GPIO_2_GPIO_Port, - .dir_pin = GPIO_2_Pin, - .thermistor_adc_ch = 15, + .step_gpio_pin = 1, + .dir_gpio_pin = 2, .thread_priority = (osPriority)(osPriorityHigh + (osPriority)1), }, .encoder_config = { @@ -96,6 +91,7 @@ const BoardHardwareConfig_t hw_configs[2] = { { .timer = &htim1, .control_deadline = TIM_1_8_PERIOD_CLOCKS, .shunt_conductance = 1.0f / SHUNT_RESISTANCE, //[S] + .inverter_thermistor_adc_ch = 15, }, .gate_driver_config = { .spi = &hspi3, @@ -111,20 +107,11 @@ const BoardHardwareConfig_t hw_configs[2] = { { //M1 .axis_config = { #if HW_VERSION_MAJOR == 3 && HW_VERSION_MINOR >= 5 - .step_port = GPIO_7_GPIO_Port, - .step_pin = GPIO_7_Pin, - .dir_port = GPIO_8_GPIO_Port, - .dir_pin = GPIO_8_Pin, + .step_gpio_pin = 7, + .dir_gpio_pin = 8, #else - .step_port = GPIO_3_GPIO_Port, - .step_pin = GPIO_3_Pin, - .dir_port = GPIO_4_GPIO_Port, - .dir_pin = GPIO_4_Pin, -#endif -#if HW_VERSION_MAJOR == 3 && HW_VERSION_MINOR >= 3 - .thermistor_adc_ch = 4, -#else - .thermistor_adc_ch = 1, + .step_gpio_pin = 3, + .dir_gpio_pin = 4, #endif .thread_priority = osPriorityHigh, }, @@ -143,6 +130,11 @@ const BoardHardwareConfig_t hw_configs[2] = { { .timer = &htim8, .control_deadline = (3 * TIM_1_8_PERIOD_CLOCKS) / 2, .shunt_conductance = 1.0f / SHUNT_RESISTANCE, //[S] +#if HW_VERSION_MAJOR == 3 && HW_VERSION_MINOR >= 3 + .inverter_thermistor_adc_ch = 4, +#else + .inverter_thermistor_adc_ch = 1, +#endif }, .gate_driver_config = { .spi = &hspi3, diff --git a/Firmware/MotorControl/controller.cpp b/Firmware/MotorControl/controller.cpp index bf50a15a..4e46c88b 100644 --- a/Firmware/MotorControl/controller.cpp +++ b/Firmware/MotorControl/controller.cpp @@ -13,6 +13,11 @@ void Controller::reset() { current_setpoint_ = 0.0f; } +void Controller::set_error(Error_t error) { + error_ |= error; + axis_->error_ |= Axis::ERROR_CONTROLLER_FAILED; +} + //-------------------------------- // Command Handling //-------------------------------- @@ -113,11 +118,36 @@ bool Controller::update(float pos_estimate, float vel_estimate, float* current_s anticogging_pos = pos_setpoint_; // FF the position setpoint instead of the pos_estimate } + // Ramp rate limited velocity setpoint + if (config_.control_mode == CTRL_MODE_VELOCITY_CONTROL && vel_ramp_enable_) { + float max_step_size = current_meas_period * config_.vel_ramp_rate; + float full_step = vel_ramp_target_ - vel_setpoint_; + float step; + if (fabsf(full_step) > max_step_size) { + step = std::copysignf(max_step_size, full_step); + } else { + step = full_step; + } + vel_setpoint_ += step; + } + // Position control // TODO Decide if we want to use encoder or pll position here float vel_des = vel_setpoint_; if (config_.control_mode >= CTRL_MODE_POSITION_CONTROL) { - float pos_err = pos_setpoint_ - pos_estimate; + float pos_err; + if (config_.setpoints_in_cpr) { + // TODO this breaks the semantics that estimates come in on the arguments. + // It's probably better to call a get_estimate that will arbitrate (enc vs sensorless) instead. + float cpr = (float)(axis_->encoder_.config_.cpr); + // Keep pos setpoint from drifting + pos_setpoint_ = fmodf_pos(pos_setpoint_, cpr); + // Circular delta + pos_err = pos_setpoint_ - axis_->encoder_.pos_cpr_; + pos_err = wrap_pm(pos_err, 0.5f * cpr); + } else { + pos_err = pos_setpoint_ - pos_estimate; + } vel_des += config_.pos_gain * pos_err; } @@ -126,6 +156,14 @@ bool Controller::update(float pos_estimate, float vel_estimate, float* current_s if (vel_des > vel_lim) vel_des = vel_lim; if (vel_des < -vel_lim) vel_des = -vel_lim; + // Check for overspeed fault (done in this module (controller) for cohesion with vel_lim) + if (config_.vel_limit_tolerance > 0.0f) { // 0.0f to disable + if (fabsf(vel_estimate) > config_.vel_limit_tolerance * vel_lim) { + set_error(ERROR_OVERSPEED); + return false; + } + } + // Velocity control float Iq = current_setpoint_; @@ -145,8 +183,8 @@ bool Controller::update(float pos_estimate, float vel_estimate, float* current_s Iq += vel_integrator_current_; // Current limiting - float Ilim = std::min(axis_->motor_.config_.current_lim, axis_->motor_.current_control_.max_allowed_current); bool limited = false; + float Ilim = axis_->motor_.effective_current_lim(); if (Iq > Ilim) { limited = true; Iq = Ilim; diff --git a/Firmware/MotorControl/controller.hpp b/Firmware/MotorControl/controller.hpp index 3db712e4..b39c2890 100644 --- a/Firmware/MotorControl/controller.hpp +++ b/Firmware/MotorControl/controller.hpp @@ -7,6 +7,11 @@ class Controller { public: + enum Error_t { + ERROR_NONE = 0, + ERROR_OVERSPEED = 0x01, + }; + // Note: these should be sorted from lowest level of control to // highest level of control, to allow "<" style comparisons. enum ControlMode_t{ @@ -23,11 +28,15 @@ public: float vel_gain = 5.0f / 10000.0f; // [A/(counts/s)] // float vel_gain = 5.0f / 200.0f, // [A/(rad/s)] float vel_integrator_gain = 10.0f / 10000.0f; // [A/(counts/s * s)] - float vel_limit = 20000.0f; // [counts/s] + float vel_limit = 20000.0f; // [counts/s] + float vel_limit_tolerance = 1.2f; // ratio to vel_lim. 0.0f to disable + float vel_ramp_rate = 10000.0f; // [(counts/s) / s] + bool setpoints_in_cpr = false; }; Controller(Config_t& config); void reset(); + void set_error(Error_t error); void set_pos_setpoint(float pos_setpoint, float vel_feed_forward, float current_feed_forward); void set_vel_setpoint(float vel_setpoint, float current_feed_forward); @@ -68,28 +77,37 @@ public: .calib_vel_threshold = 1.0f, }; + Error_t error_ = ERROR_NONE; // variables exposed on protocol float pos_setpoint_ = 0.0f; float vel_setpoint_ = 0.0f; // float vel_setpoint = 800.0f; float vel_integrator_current_ = 0.0f; // [A] float current_setpoint_ = 0.0f; // [A] + float vel_ramp_target_ = 0.0f; + bool vel_ramp_enable_ = false; uint32_t traj_start_loop_count_ = 0; // Communication protocol definitions auto make_protocol_definitions() { return make_protocol_member_list( + make_protocol_property("error", &error_), make_protocol_property("pos_setpoint", &pos_setpoint_), make_protocol_property("vel_setpoint", &vel_setpoint_), make_protocol_property("vel_integrator_current", &vel_integrator_current_), make_protocol_property("current_setpoint", ¤t_setpoint_), + make_protocol_property("vel_ramp_target", &vel_ramp_target_), + make_protocol_property("vel_ramp_enable", &vel_ramp_enable_), make_protocol_object("config", make_protocol_property("control_mode", &config_.control_mode), make_protocol_property("pos_gain", &config_.pos_gain), make_protocol_property("vel_gain", &config_.vel_gain), make_protocol_property("vel_integrator_gain", &config_.vel_integrator_gain), - make_protocol_property("vel_limit", &config_.vel_limit) + make_protocol_property("vel_limit", &config_.vel_limit), + make_protocol_property("vel_limit_tolerance", &config_.vel_limit_tolerance), + make_protocol_property("vel_ramp_rate", &config_.vel_ramp_rate), + make_protocol_property("setpoints_in_cpr", &config_.setpoints_in_cpr) ), make_protocol_function("set_pos_setpoint", *this, &Controller::set_pos_setpoint, "pos_setpoint", "vel_feed_forward", "current_feed_forward"), @@ -103,4 +121,6 @@ public: } }; +DEFINE_ENUM_FLAG_OPERATORS(Controller::Error_t) + #endif // __CONTROLLER_HPP diff --git a/Firmware/MotorControl/encoder.cpp b/Firmware/MotorControl/encoder.cpp index e5dc8fae..7d0b8714 100644 --- a/Firmware/MotorControl/encoder.cpp +++ b/Firmware/MotorControl/encoder.cpp @@ -24,7 +24,7 @@ void Encoder::setup() { enc_index_cb_wrapper, this); } -void Encoder::set_error(Encoder::Error_t error) { +void Encoder::set_error(Error_t error) { error_ |= error; axis_->error_ |= Axis::ERROR_ENCODER_FAILED; } @@ -46,7 +46,8 @@ void Encoder::enc_index_cb() { if (config_.find_idx_on_lockin && axis_->lockin_state_ != Axis::LOCKIN_STATE_CONST_VEL) return; set_circular_count(0, false); - set_linear_count(0); // Avoid position control transient after search + if (config_.zero_count_on_find_idx) + set_linear_count(0); // Avoid position control transient after search if (config_.pre_calibrated) { is_ready_ = true; } else { @@ -221,6 +222,27 @@ void Encoder::update_pll_gains() { } } +void Encoder::sample_now() { + switch (config_.mode) { + case MODE_INCREMENTAL: { + tim_cnt_sample_ = (int16_t)hw_config_.timer->Instance->CNT; + } break; + + case MODE_HALL: { + // do nothing: samples already captured in general GPIO capture + } break; + + case MODE_SINCOS: { + sincos_sample_s_ = get_adc_voltage(GPIO_3_GPIO_Port, GPIO_3_Pin) / 3.3f; + sincos_sample_c_ = get_adc_voltage(GPIO_4_GPIO_Port, GPIO_4_Pin) / 3.3f; + } break; + + default: { + set_error(ERROR_UNSUPPORTED_ENCODER_MODE); + } break; + } +} + bool Encoder::update() { // update internal encoder state. int32_t delta_enc = 0; @@ -228,7 +250,7 @@ bool Encoder::update() { case MODE_INCREMENTAL: { //TODO: use count_in_cpr_ instead as shadow_count_ can overflow //or use 64 bit - int16_t delta_enc_16 = (int16_t)hw_config_.timer->Instance->CNT - (int16_t)shadow_count_; + int16_t delta_enc_16 = (int16_t)tim_cnt_sample_ - (int16_t)shadow_count_; delta_enc = (int32_t)delta_enc_16; //sign extend } break; @@ -240,10 +262,23 @@ bool Encoder::update() { if (delta_enc > 3) delta_enc -= 6; } else { - set_error(ERROR_ILLEGAL_HALL_STATE); - return false; + if (!config_.ignore_illegal_hall_state) { + set_error(ERROR_ILLEGAL_HALL_STATE); + return false; + } } } break; + + case MODE_SINCOS: { + float phase = fast_atan2(sincos_sample_s_, sincos_sample_c_); + int fake_count = (int)(1000.0f * phase); + //CPR = 6283 = 2pi * 1k + + delta_enc = fake_count - count_in_cpr_; + delta_enc = mod(delta_enc, 6283); + if (delta_enc > 6283/2) + delta_enc -= 6283; + } break; default: { set_error(ERROR_UNSUPPORTED_ENCODER_MODE); diff --git a/Firmware/MotorControl/encoder.hpp b/Firmware/MotorControl/encoder.hpp index 38889c12..d01d4ed3 100644 --- a/Firmware/MotorControl/encoder.hpp +++ b/Firmware/MotorControl/encoder.hpp @@ -20,7 +20,8 @@ public: enum Mode_t { MODE_INCREMENTAL, - MODE_HALL + MODE_HALL, + MODE_SINCOS }; struct Config_t { @@ -32,6 +33,7 @@ public: // In this case the encoder will enter ready // state as soon as the index is found. float idx_search_speed = 10.0f; // [rad/s electrical] + bool zero_count_on_find_idx = true; int32_t cpr = (2048 * 4); // Default resolution of CUI-AMT102 encoder, int32_t offset = 0; // Offset between encoder count and rotor electrical phase float offset_float = 0.0f; // Sub-count phase alignment offset @@ -40,6 +42,7 @@ public: float overspeed_fault_ratio = 1.2f; // ratio of vel_lim, 0.0f = disabled bool find_idx_on_lockin = false; bool idx_search_unidirectional = false; + bool ignore_illegal_hall_state = false; }; Encoder(const EncoderHardwareConfig_t& hw_config, @@ -57,6 +60,7 @@ public: bool run_index_search(); bool run_offset_calibration(); + void sample_now(); bool update(); void update_pll_gains(); @@ -71,15 +75,18 @@ public: int32_t shadow_count_ = 0; int32_t count_in_cpr_ = 0; float interpolation_ = 0.0f; - float phase_ = 0.0f; // [rad] - float pos_estimate_ = 0.0f; // [rad] - float pos_cpr_ = 0.0f; // [rad] - float vel_estimate_ = 0.0f; // [rad/s] - float pll_kp_ = 0.0f; // [rad/s / rad] - float pll_ki_ = 0.0f; // [(rad/s^2) / rad] + float phase_ = 0.0f; // [count] + float pos_estimate_ = 0.0f; // [count] + float pos_cpr_ = 0.0f; // [count] + float vel_estimate_ = 0.0f; // [count/s] + float pll_kp_ = 0.0f; // [count/s / count] + float pll_ki_ = 0.0f; // [(count/s^2) / count] + int16_t tim_cnt_sample_ = 0; // // Updated by low_level pwm_adc_cb uint8_t hall_state_ = 0x0; // bit[0] = HallA, .., bit[2] = HallC + float sincos_sample_s_ = 0.0f; + float sincos_sample_c_ = 0.0f; // Communication protocol definitions auto make_protocol_definitions() { @@ -103,6 +110,7 @@ public: make_protocol_property("pre_calibrated", &config_.pre_calibrated), make_protocol_property("overspeed_fault_ratio", &config_.overspeed_fault_ratio), make_protocol_property("idx_search_speed", &config_.idx_search_speed), + make_protocol_property("zero_count_on_find_idx", &config_.zero_count_on_find_idx), make_protocol_property("cpr", &config_.cpr), make_protocol_property("offset", &config_.offset), make_protocol_property("offset_float", &config_.offset_float), @@ -110,7 +118,8 @@ public: [](void* ctx) { static_cast(ctx)->update_pll_gains(); }, this), make_protocol_property("calib_range", &config_.calib_range), make_protocol_property("find_idx_on_lockin", &config_.find_idx_on_lockin), - make_protocol_property("idx_search_unidirectional", &config_.idx_search_unidirectional) + make_protocol_property("idx_search_unidirectional", &config_.idx_search_unidirectional), + make_protocol_property("ignore_illegal_hall_state", &config_.ignore_illegal_hall_state) ) ); } diff --git a/Firmware/MotorControl/low_level.cpp b/Firmware/MotorControl/low_level.cpp index d807dc33..6125c99c 100644 --- a/Firmware/MotorControl/low_level.cpp +++ b/Firmware/MotorControl/low_level.cpp @@ -125,7 +125,7 @@ bool safety_critical_disarm_motor_pwm(Motor& motor) { void safety_critical_apply_motor_pwm_timings(Motor& motor, uint16_t timings[3]) { uint32_t mask = cpu_enter_critical(); if (!brake_resistor_armed) { - motor.armed_state_ = Motor::ARMED_STATE_ARMED; + motor.armed_state_ = Motor::ARMED_STATE_DISARMED; } motor.hw_config_.timer->Instance->CCR1 = timings[0]; @@ -216,7 +216,8 @@ void start_adc_pwm() { start_pwm(&htim1); start_pwm(&htim8); // TODO: explain why this offset - sync_timers(&htim1, &htim8, TIM_CLOCKSOURCE_ITR0, TIM_1_8_PERIOD_CLOCKS / 2 - 1 * 128); + sync_timers(&htim1, &htim8, TIM_CLOCKSOURCE_ITR0, TIM_1_8_PERIOD_CLOCKS / 2 - 1 * 128, + &htim13); // Motor output starts in the disabled state __HAL_TIM_MOE_DISABLE_UNCONDITIONALLY(&htim1); @@ -259,7 +260,8 @@ void start_pwm(TIM_HandleTypeDef* htim) { } void sync_timers(TIM_HandleTypeDef* htim_a, TIM_HandleTypeDef* htim_b, - uint16_t TIM_CLOCKSOURCE_ITRx, uint16_t count_offset) { + uint16_t TIM_CLOCKSOURCE_ITRx, uint16_t count_offset, + TIM_HandleTypeDef* htim_refbase) { // Store intial timer configs uint16_t MOE_store_a = htim_a->Instance->BDTR & (TIM_BDTR_MOE); uint16_t MOE_store_b = htim_b->Instance->BDTR & (TIM_BDTR_MOE); @@ -294,6 +296,11 @@ void sync_timers(TIM_HandleTypeDef* htim_a, TIM_HandleTypeDef* htim_b, // set counter offset htim_a->Instance->CNT = count_offset; htim_b->Instance->CNT = 0; + // Set and start reference timebase timer (if used) + if (htim_refbase) { + htim_refbase->Instance->CNT = count_offset; + htim_refbase->Instance->CR1 |= (TIM_CR1_CEN); // start + } // Start Timer a htim_a->Instance->CR1 |= (TIM_CR1_CEN); // Restore timer configs @@ -475,8 +482,14 @@ void pwm_trig_adc_cb(ADC_HandleTypeDef* hadc, bool injected) { int axis_num = injected ? 0 : 1; Axis& other_axis = injected ? *axes[1] : *axes[0]; bool counting_down = axis.motor_.hw_config_.timer->Instance->CR1 & TIM_CR1_DIR; - bool current_meas_not_DC_CAL = !counting_down; + + // Check the timing of the sequencing + if (current_meas_not_DC_CAL) + axis.motor_.log_timing(Motor::TIMING_LOG_ADC_CB_I); + else + axis.motor_.log_timing(Motor::TIMING_LOG_ADC_CB_DC); + bool update_timings = false; if (hadc == &hadc2) { if (&axis == axes[1] && counting_down) @@ -503,12 +516,6 @@ void pwm_trig_adc_cb(ADC_HandleTypeDef* hadc, bool injected) { update_brake_current(); } - // Check the timing of the sequencing - if (current_meas_not_DC_CAL) - axis.motor_.log_timing(Motor::TIMING_LOG_ADC_CB_I); - else - axis.motor_.log_timing(Motor::TIMING_LOG_ADC_CB_DC); - uint32_t ADCValue; if (injected) { ADCValue = HAL_ADCEx_InjectedGetValue(hadc, ADC_INJECTED_RANK_1); @@ -532,6 +539,7 @@ void pwm_trig_adc_cb(ADC_HandleTypeDef* hadc, bool injected) { axis.motor_.current_meas_.phC = current - axis.motor_.DC_calib_.phC; } // Prepare hall readings + // TODO move this to inside encoder update function decode_hall_samples(axis.encoder_, GPIO_port_samples[axis_num]); // Trigger axis thread axis.signal_current_meas(); @@ -546,18 +554,30 @@ void pwm_trig_adc_cb(ADC_HandleTypeDef* hadc, bool injected) { } void tim_update_cb(TIM_HandleTypeDef* htim) { - int portsamples_arr; + + // If the corresponding timer is counting up, we just sampled in SVM vector 0, i.e. real current + // If we are counting down, we just sampled in SVM vector 7, with zero current + bool counting_down = htim->Instance->CR1 & TIM_CR1_DIR; + if (counting_down) + return; + + int sample_ch; + Axis* axis; if (htim == &htim1) { - portsamples_arr = 0; + sample_ch = 0; + axis = axes[0]; } else if (htim == &htim8) { - portsamples_arr = 1; + sample_ch = 1; + axis = axes[1]; } else { low_level_fault(Motor::ERROR_UNEXPECTED_TIMER_CALLBACK); return; } + axis->encoder_.sample_now(); + for (int i = 0; i < num_GPIO; ++i) { - GPIO_port_samples[portsamples_arr][i] = GPIOs_to_samp[i]->IDR; + GPIO_port_samples[sample_ch][i] = GPIOs_to_samp[i]->IDR; } } @@ -660,6 +680,7 @@ void pwm_in_init() { } } +//TODO: These expressions have integer division by 1MHz, so it will be incorrect for clock speeds of not-integer MHz #define TIM_2_5_CLOCK_HZ TIM_APB1_CLOCK_HZ #define PWM_MIN_HIGH_TIME ((TIM_2_5_CLOCK_HZ / 1000000UL) * 1000UL) // 1ms high is considered full reverse #define PWM_MAX_HIGH_TIME ((TIM_2_5_CLOCK_HZ / 1000000UL) * 2000UL) // 2ms high is considered full forward @@ -705,4 +726,33 @@ void pwm_in_cb(int channel, uint32_t timestamp) { last_timestamp[gpio_num - 1] = timestamp; last_pin_state[gpio_num - 1] = current_pin_state; last_sample_valid[gpio_num - 1] = true; -} \ No newline at end of file +} + + +/* Analog speed control input */ + +static void update_analog_endpoint(const struct PWMMapping_t *map, int gpio) +{ + float fraction = get_adc_voltage(get_gpio_port_by_pin(gpio), get_gpio_pin_by_pin(gpio)) / 3.3f; + float value = map->min + (fraction * (map->max - map->min)); + get_endpoint(map->endpoint)->set_from_float(value); +} + +static void analog_polling_thread(void *) +{ + while (true) { + for (int i = 0; i < GPIO_COUNT; i++) { + struct PWMMapping_t *map = &board_config.analog_mappings[i]; + + if (is_endpoint_ref_valid(map->endpoint)) + update_analog_endpoint(map, i + 1); + } + osDelay(10); + } +} + +void start_analog_thread() +{ + osThreadDef(thread_def, analog_polling_thread, osPriorityLow, 0, 4*512); + osThreadCreate(osThread(thread_def), NULL); +} diff --git a/Firmware/MotorControl/low_level.h b/Firmware/MotorControl/low_level.h index 0b594e34..503b98e1 100644 --- a/Firmware/MotorControl/low_level.h +++ b/Firmware/MotorControl/low_level.h @@ -46,16 +46,19 @@ void pwm_in_cb(int channel, uint32_t timestamp); void start_adc_pwm(); void start_pwm(TIM_HandleTypeDef* htim); void sync_timers(TIM_HandleTypeDef* htim_a, TIM_HandleTypeDef* htim_b, - uint16_t TIM_CLOCKSOURCE_ITRx, uint16_t count_offset); + uint16_t TIM_CLOCKSOURCE_ITRx, uint16_t count_offset, + TIM_HandleTypeDef* htim_refbase = nullptr); void start_general_purpose_adc(); float get_adc_voltage(GPIO_TypeDef* GPIO_port, uint16_t GPIO_pin); void pwm_in_init(); +void start_analog_thread(); void update_brake_current(); inline uint32_t cpu_enter_critical() { - return __get_PRIMASK(); + uint32_t primask = __get_PRIMASK(); __disable_irq(); + return primask; } inline void cpu_exit_critical(uint32_t priority_mask) { diff --git a/Firmware/MotorControl/main.cpp b/Firmware/MotorControl/main.cpp index 4550605e..b25da149 100644 --- a/Firmware/MotorControl/main.cpp +++ b/Firmware/MotorControl/main.cpp @@ -65,6 +65,8 @@ void load_configuration(void) { motor_configs[i] = Motor::Config_t(); trap_configs[i] = TrapezoidalTrajectory::Config_t(); axis_configs[i] = Axis::Config_t(); + // Default step/dir pins are different, so we need to explicitly load them + Axis::load_default_step_dir_pin_config(hw_configs[i].axis_config, &axis_configs[i]); } } else { user_config_loaded_ = true; @@ -178,8 +180,6 @@ int odrive_main(void) { // TODO: make dynamically reconfigurable #if HW_VERSION_MAJOR == 3 && HW_VERSION_MINOR >= 3 if (board_config.enable_uart) { - axes[0]->config_.enable_step_dir = false; - axes[0]->set_step_dir_enabled(false); SetGPIO12toUART(); } #endif @@ -214,6 +214,8 @@ int odrive_main(void) { axes[i]->start_thread(); } + start_analog_thread(); + system_stats_.fully_booted = true; return 0; } diff --git a/Firmware/MotorControl/motor.cpp b/Firmware/MotorControl/motor.cpp index 230f7f64..6fa01cc8 100644 --- a/Firmware/MotorControl/motor.cpp +++ b/Firmware/MotorControl/motor.cpp @@ -73,7 +73,8 @@ void Motor::DRV8301_setup() { // Solve for exact gain, then snap down to have equal or larger range as requested // or largest possible range otherwise static const float kMargin = 0.90f; - static const float max_output_swing = 1.6f; // [V] out of amplifier + static const float kTripMargin = 1.0f; // Trip level is at edge of linear range of amplifer + static const float max_output_swing = 1.35f; // [V] out of amplifier float max_unity_gain_current = kMargin * max_output_swing * hw_config_.shunt_conductance; // [A] float requested_gain = max_unity_gain_current / config_.requested_current_range; // [V/V] @@ -99,6 +100,8 @@ void Motor::DRV8301_setup() { phase_current_rev_gain_ = 1.0f / gain_snap_down->first; // Clip all current control to actual usable range current_control_.max_allowed_current = max_unity_gain_current * phase_current_rev_gain_; + // Set trip level + current_control_.overcurrent_trip_level = (kTripMargin / kMargin) * current_control_.max_allowed_current; // We now have the gain settings we want to use, lets set up DRV chip DRV_SPI_8301_Vars_t* local_regs = &gate_driver_regs_; @@ -140,22 +143,57 @@ void Motor::set_error(Motor::Error_t error){ update_brake_current(); } -bool Motor::do_checks() { - if (!check_DRV_fault()) { - set_error(ERROR_DRV_FAULT); +float Motor::get_inverter_temp() { + float adc = adc_measurements_[hw_config_.inverter_thermistor_adc_ch]; + float normalized_voltage = adc / adc_full_scale; + return horner_fma(normalized_voltage, thermistor_poly_coeffs, thermistor_num_coeffs); +} + +bool Motor::update_thermal_limits() { + float fet_temp = get_inverter_temp(); + float temp_margin = config_.inverter_temp_limit_upper - fet_temp; + float derating_range = config_.inverter_temp_limit_upper - config_.inverter_temp_limit_lower; + thermal_current_lim_ = config_.current_lim * (temp_margin / derating_range); + if (!(thermal_current_lim_ >= 0.0f)) { //Funny polarity to also catch NaN + thermal_current_lim_ = 0.0f; + } + if (fet_temp > config_.inverter_temp_limit_upper + 5) { + set_error(ERROR_INVERTER_OVER_TEMP); return false; } return true; } -void Motor::log_timing(TimingLog_t log_idx) { - TIM_HandleTypeDef* htim = hw_config_.timer; - uint16_t timing = htim->Instance->CNT; - bool down = htim->Instance->CR1 & TIM_CR1_DIR; - if (down) { - uint16_t delta = TIM_1_8_PERIOD_CLOCKS - timing; - timing = TIM_1_8_PERIOD_CLOCKS + delta; +bool Motor::do_checks() { + if (!check_DRV_fault()) { + set_error(ERROR_DRV_FAULT); + return false; } + if (!update_thermal_limits()) { + //error already set in function + return false; + } + return true; +} + +float Motor::effective_current_lim() { + // Configured limit + float current_lim = config_.current_lim; + // Hardware limit + if (axis_->motor_.config_.motor_type == Motor::MOTOR_TYPE_GIMBAL) { + current_lim = std::min(current_lim, 0.98f*one_by_sqrt3*vbus_voltage); + } else { + current_lim = std::min(current_lim, axis_->motor_.current_control_.max_allowed_current); + } + // Thermal limit + current_lim = std::min(current_lim, thermal_current_lim_); + + return current_lim; +} + +void Motor::log_timing(TimingLog_t log_idx) { + static const uint16_t clocks_per_cnt = (uint16_t)((float)TIM_1_8_CLOCK_HZ / (float)TIM_APB1_CLOCK_HZ); + uint16_t timing = clocks_per_cnt * htim13.Instance->CNT; // TODO: Use a hw_config if (log_idx < TIMING_LOG_NUM_SLOTS) { timing_log_[log_idx] = timing; @@ -238,7 +276,7 @@ bool Motor::measure_phase_inductance(float voltage_low, float voltage_high) { config_.phase_inductance = L; // TODO arbitrary values set for now - if (L < 1e-6f || L > 2500e-6f) + if (L < 2e-6f || L > 4000e-6f) return set_error(ERROR_PHASE_INDUCTANCE_OUT_OF_RANGE), false; return true; } @@ -284,33 +322,39 @@ bool Motor::enqueue_voltage_timings(float v_alpha, float v_beta) { return true; } -// TODO: This doesn't update brake current // We should probably make FOC Current call FOC Voltage to avoid duplication. -bool Motor::FOC_voltage(float v_d, float v_q, float phase) { - float c = our_arm_cos_f32(phase); - float s = our_arm_sin_f32(phase); +bool Motor::FOC_voltage(float v_d, float v_q, float pwm_phase) { + float c = our_arm_cos_f32(pwm_phase); + float s = our_arm_sin_f32(pwm_phase); float v_alpha = c*v_d - s*v_q; float v_beta = c*v_q + s*v_d; return enqueue_voltage_timings(v_alpha, v_beta); } -bool Motor::FOC_current(float Id_des, float Iq_des, float phase) { +bool Motor::FOC_current(float Id_des, float Iq_des, float I_phase, float pwm_phase) { // Syntactic sugar CurrentControl_t& ictrl = current_control_; // For Reporting ictrl.Iq_setpoint = Iq_des; + // Check for current sense saturation + if (fabsf(current_meas_.phB) > ictrl.overcurrent_trip_level + || fabsf(current_meas_.phC) > ictrl.overcurrent_trip_level) { + set_error(ERROR_CURRENT_SENSE_SATURATION); + } + // Clarke transform float Ialpha = -current_meas_.phB - current_meas_.phC; float Ibeta = one_by_sqrt3 * (current_meas_.phB - current_meas_.phC); // Park transform - float c = our_arm_cos_f32(phase); - float s = our_arm_sin_f32(phase); - float Id = c * Ialpha + s * Ibeta; - float Iq = c * Ibeta - s * Ialpha; - ictrl.Iq_measured = Iq; + float c_I = our_arm_cos_f32(I_phase); + float s_I = our_arm_sin_f32(I_phase); + float Id = c_I * Ialpha + s_I * Ibeta; + float Iq = c_I * Ibeta - s_I * Ialpha; + ictrl.Iq_measured += ictrl.I_measured_report_filter_k * (Iq - ictrl.Iq_measured); + ictrl.Id_measured += ictrl.I_measured_report_filter_k * (Id - ictrl.Id_measured); // Current error float Ierr_d = Id_des - Id; @@ -344,8 +388,10 @@ bool Motor::FOC_current(float Id_des, float Iq_des, float phase) { ictrl.Ibus = mod_d * Id + mod_q * Iq; // Inverse park transform - float mod_alpha = c * mod_d - s * mod_q; - float mod_beta = c * mod_q + s * mod_d; + float c_p = our_arm_cos_f32(pwm_phase); + float s_p = our_arm_sin_f32(pwm_phase); + float mod_alpha = c_p * mod_d - s_p * mod_q; + float mod_beta = c_p * mod_q + s_p * mod_d; // Report final applied voltage in stationary frame (for sensorles estimator) ictrl.final_v_alpha = mod_to_V * mod_alpha; @@ -360,19 +406,22 @@ bool Motor::FOC_current(float Id_des, float Iq_des, float phase) { } -bool Motor::update(float current_setpoint, float phase) { +bool Motor::update(float current_setpoint, float phase, float phase_vel) { current_setpoint *= config_.direction; phase *= config_.direction; + phase_vel *= config_.direction; + + float pwm_phase = phase + 1.5f * current_meas_period * phase_vel; // Execute current command // TODO: move this into the mot if (config_.motor_type == MOTOR_TYPE_HIGH_CURRENT) { - if(!FOC_current(0.0f, current_setpoint, phase)){ + if(!FOC_current(0.0f, current_setpoint, phase, pwm_phase)){ return false; } } else if (config_.motor_type == MOTOR_TYPE_GIMBAL) { //In gimbal motor mode, current is reinterptreted as voltage. - if(!FOC_voltage(0.0f, current_setpoint, phase)) + if(!FOC_voltage(0.0f, current_setpoint, pwm_phase)) return false; } else { set_error(ERROR_NOT_IMPLEMENTED_MOTOR_TYPE); diff --git a/Firmware/MotorControl/motor.hpp b/Firmware/MotorControl/motor.hpp index b67d4874..279e6848 100644 --- a/Firmware/MotorControl/motor.hpp +++ b/Firmware/MotorControl/motor.hpp @@ -20,7 +20,9 @@ public: ERROR_BRAKE_CURRENT_OUT_OF_RANGE = 0x0040, ERROR_MODULATION_MAGNITUDE = 0x0080, ERROR_BRAKE_DEADTIME_VIOLATION = 0x0100, - ERROR_UNEXPECTED_TIMER_CALLBACK = 0x0200 + ERROR_UNEXPECTED_TIMER_CALLBACK = 0x0200, + ERROR_CURRENT_SENSE_SATURATION = 0x0400, + ERROR_INVERTER_OVER_TEMP = 0x0800 }; enum MotorType_t { @@ -43,9 +45,12 @@ public: // Voltage applied at end of cycle: float final_v_alpha; // [V] float final_v_beta; // [V] - float Iq_setpoint; - float Iq_measured; - float max_allowed_current; + float Iq_setpoint; // [A] + float Iq_measured; // [A] + float Id_measured; // [A] + float I_measured_report_filter_k; + float max_allowed_current; // [A] + float overcurrent_trip_level; // [A] }; // NOTE: for gimbal motors, all units of A are instead V. @@ -64,8 +69,10 @@ public: // float current_lim = 70.0f; //[A] float current_lim = 10.0f; //[A] // Value used to compute shunt amplifier gains - float requested_current_range = 70.0f; // [A] + float requested_current_range = 60.0f; // [A] float current_control_bandwidth = 1000.0f; // [rad/s] + float inverter_temp_limit_lower = 100; + float inverter_temp_limit_upper = 120; }; enum TimingLog_t { @@ -104,6 +111,9 @@ public: bool check_DRV_fault(); void set_error(Error_t error); bool do_checks(); + float get_inverter_temp(); + bool update_thermal_limits(); + float effective_current_lim(); void log_timing(TimingLog_t log_idx); float phase_current_from_adcval(uint32_t ADCValue); bool measure_phase_resistance(float test_current, float max_voltage); @@ -111,9 +121,9 @@ public: bool run_calibration(); bool enqueue_modulation_timings(float mod_alpha, float mod_beta); bool enqueue_voltage_timings(float v_alpha, float v_beta); - bool FOC_voltage(float v_d, float v_q, float phase); - bool FOC_current(float Id_des, float Iq_des, float phase); - bool update(float current_setpoint, float phase); + bool FOC_voltage(float v_d, float v_q, float pwm_phase); + bool FOC_current(float Id_des, float Iq_des, float I_phase, float pwm_phase); + bool update(float current_setpoint, float phase, float phase_vel); const MotorHardwareConfig_t& hw_config_; const GateDriverHardwareConfig_t gate_driver_config_; @@ -152,10 +162,14 @@ public: .final_v_beta = 0.0f, .Iq_setpoint = 0.0f, .Iq_measured = 0.0f, + .Id_measured = 0.0f, + .I_measured_report_filter_k = 1.0f, .max_allowed_current = 0.0f, + .overcurrent_trip_level = 0.0f, }; DRV8301_FaultType_e drv_fault_ = DRV8301_FaultType_NoFault; DRV_SPI_8301_Vars_t gate_driver_regs_; //Local view of DRV registers (initialized by DRV8301_setup) + float thermal_current_lim_ = 10.0f; //[A] // Communication protocol definitions auto make_protocol_definitions() { @@ -168,6 +182,8 @@ public: make_protocol_property("DC_calib_phB", &DC_calib_.phB), make_protocol_property("DC_calib_phC", &DC_calib_.phC), make_protocol_property("phase_current_rev_gain", &phase_current_rev_gain_), + make_protocol_ro_property("thermal_current_lim", &thermal_current_lim_), + make_protocol_function("get_inverter_temp", *this, &Motor::get_inverter_temp), make_protocol_object("current_control", make_protocol_property("p_gain", ¤t_control_.p_gain), make_protocol_property("i_gain", ¤t_control_.i_gain), @@ -178,7 +194,10 @@ public: make_protocol_property("final_v_beta", ¤t_control_.final_v_beta), make_protocol_property("Iq_setpoint", ¤t_control_.Iq_setpoint), make_protocol_property("Iq_measured", ¤t_control_.Iq_measured), - make_protocol_property("max_allowed_current", ¤t_control_.max_allowed_current) + make_protocol_property("Id_measured", ¤t_control_.Id_measured), + make_protocol_property("I_measured_report_filter_k", ¤t_control_.I_measured_report_filter_k), + make_protocol_ro_property("max_allowed_current", ¤t_control_.max_allowed_current), + make_protocol_ro_property("overcurrent_trip_level", ¤t_control_.overcurrent_trip_level) ), make_protocol_object("gate_driver", make_protocol_ro_property("drv_fault", &drv_fault_) @@ -208,6 +227,8 @@ public: make_protocol_property("direction", &config_.direction), make_protocol_property("motor_type", &config_.motor_type), make_protocol_property("current_lim", &config_.current_lim), + make_protocol_property("inverter_temp_limit_lower", &config_.inverter_temp_limit_lower), + make_protocol_property("inverter_temp_limit_upper", &config_.inverter_temp_limit_upper), make_protocol_property("requested_current_range", &config_.requested_current_range), make_protocol_property("current_control_bandwidth", &config_.current_control_bandwidth, [](void* ctx) { static_cast(ctx)->update_current_controller_gains(); }, this) diff --git a/Firmware/MotorControl/odrive_main.h b/Firmware/MotorControl/odrive_main.h index 776f1590..df1bc14b 100644 --- a/Firmware/MotorControl/odrive_main.h +++ b/Firmware/MotorControl/odrive_main.h @@ -82,6 +82,7 @@ struct BoardConfig_t { // tup.config +tup init tup generate ./tup_build.sh bash -xe ./tup_build.sh diff --git a/Firmware/communication/ascii_protocol.cpp b/Firmware/communication/ascii_protocol.cpp index 0981cc1d..3ac68499 100644 --- a/Firmware/communication/ascii_protocol.cpp +++ b/Firmware/communication/ascii_protocol.cpp @@ -102,6 +102,21 @@ void ASCII_protocol_process_line(const uint8_t* buffer, size_t len, StreamSink& axes[motor_number]->controller_.set_pos_setpoint(pos_setpoint, vel_feed_forward, current_feed_forward); } + } else if (cmd[0] == 'q') { // position control with limits + unsigned motor_number; + float pos_setpoint, vel_limit, current_lim; + int numscan = sscanf(cmd, "q %u %f %f %f", &motor_number, &pos_setpoint, &vel_limit, ¤t_lim); + if (numscan < 4) { + respond(response_channel, use_checksum, "invalid command format"); + } else if (motor_number >= AXIS_COUNT) { + respond(response_channel, use_checksum, "invalid motor %u", motor_number); + } else { + Axis* axis = axes[motor_number]; + axis->controller_.pos_setpoint_ = pos_setpoint; + axis->controller_.config_.vel_limit = vel_limit; + axis->motor_.config_.current_lim = current_lim; + } + } else if (cmd[0] == 'v') { // velocity control unsigned motor_number; float vel_setpoint, current_feed_forward; @@ -140,6 +155,19 @@ void ASCII_protocol_process_line(const uint8_t* buffer, size_t len, StreamSink& axes[motor_number]->controller_.move_to_pos(goal_point); } + } else if (cmd[0] == 'f') { // feedback + unsigned motor_number; + int numscan = sscanf(cmd, "f %u", &motor_number); + if (numscan < 1) { + respond(response_channel, use_checksum, "invalid command format"); + } else if (motor_number >= AXIS_COUNT) { + respond(response_channel, use_checksum, "invalid motor %u", motor_number); + } else { + respond(response_channel, use_checksum, "%f %f", + (double)axes[motor_number]->encoder_.pos_estimate_, + (double)axes[motor_number]->encoder_.vel_estimate_); + } + } else if (cmd[0] == 'h') { // Help respond(response_channel, use_checksum, "Please see documentation for more details"); respond(response_channel, use_checksum, ""); @@ -160,6 +188,13 @@ void ASCII_protocol_process_line(const uint8_t* buffer, size_t len, StreamSink& respond(response_channel, use_checksum, "Firmware version: %d.%d.%d", FW_VERSION_MAJOR, FW_VERSION_MINOR, FW_VERSION_REVISION); respond(response_channel, use_checksum, "Serial number: %s", serial_number_str); + } else if (cmd[0] == 's'){ // Save config + save_configuration(); + } else if (cmd[0] == 'e'){ // Erase config + erase_configuration(); + } else if (cmd[0] == 'b'){ // Reboot + NVIC_SystemReset(); + } else if (cmd[0] == 'r') { // read property char name[MAX_LINE_LENGTH]; int numscan = sscanf(cmd, "r %" TO_STR(MAX_LINE_LENGTH) "s", name); diff --git a/Firmware/communication/communication.cpp b/Firmware/communication/communication.cpp index 0198e6c8..7c08654a 100644 --- a/Firmware/communication/communication.cpp +++ b/Firmware/communication/communication.cpp @@ -84,7 +84,7 @@ void init_communication(void) { printf("hi!\r\n"); // Start command handling thread - osThreadDef(task_cmd_parse, communication_task, osPriorityNormal, 0, 5500 /* in 32-bit words */); // TODO: fix stack issues + osThreadDef(task_cmd_parse, communication_task, osPriorityNormal, 0, 6000 /* in 32-bit words */); // TODO: fix stack issues comm_thread = osThreadCreate(osThread(task_cmd_parse), NULL); while (!endpoint_list_valid) @@ -163,8 +163,11 @@ static inline auto make_obj_tree() { make_protocol_object("gpio2_pwm_mapping", make_protocol_definitions(board_config.pwm_mappings[1])), make_protocol_object("gpio3_pwm_mapping", make_protocol_definitions(board_config.pwm_mappings[2])), #endif - make_protocol_object("gpio4_pwm_mapping", make_protocol_definitions(board_config.pwm_mappings[3])) - ), + make_protocol_object("gpio4_pwm_mapping", make_protocol_definitions(board_config.pwm_mappings[3])), + + make_protocol_object("gpio3_analog_mapping", make_protocol_definitions(board_config.analog_mappings[2])), + make_protocol_object("gpio4_analog_mapping", make_protocol_definitions(board_config.analog_mappings[3])) + ), make_protocol_object("axis0", axes[0]->make_protocol_definitions()), make_protocol_object("axis1", axes[1]->make_protocol_definitions()), make_protocol_object("can", can1_ctx.make_protocol_definitions()), diff --git a/Firmware/fibre/python/fibre/shell.py b/Firmware/fibre/python/fibre/shell.py index 9dd31d7a..d5e24d85 100644 --- a/Firmware/fibre/python/fibre/shell.py +++ b/Firmware/fibre/python/fibre/shell.py @@ -81,6 +81,7 @@ def launch_shell(args, # If IPython is installed, embed IPython shell, otherwise embed regular shell if use_ipython: help = lambda: print_help(args, len(discovered_devices) > 0) # Override help function # pylint: disable=W0612 + locals()['__name__'] = globals()['__name__'] # to fix broken "%run -i script.py" console = IPython.terminal.embed.InteractiveShellEmbed(banner1='') console.runcode = console.run_code # hack to make IPython look like the regular console interact = console diff --git a/Firmware/sampler.py b/Firmware/sampler.py new file mode 100644 index 00000000..08dc126e --- /dev/null +++ b/Firmware/sampler.py @@ -0,0 +1,124 @@ +#!/usr/bin/python2 + +# run openocd (0.9.0) with : +# $ openocd -f stlink-v2-1.cfg -f stm32f4x.cfg &> /dev/null" +# then run +# $ python2 sampler.py path_to_myelf_with_symbols + +import sys +import time +import telnetlib +import subprocess +from bisect import bisect_right +import operator + +class OpenOCDCMSampler(object): + + def __init__(self, host='localhost', port=4444): + + self.net = telnetlib.Telnet(host, port) + self.net.read_very_eager() + + self.table = [] + self.indexes = set() + + def __del__(self): + self.net.write(b'exit\r\n') + self.net.read_until(b'exit\r\n', 1) + self.net.close() + + def getpc(self): + + self.net.write(b'mrw 0xE000101C\r\n') + res = self.net.read_until(b'\r\n\r> ', 1) + + if res: + prefix = res[0:16] + num = res[16:-5] + res = res[-15:0] + + if prefix == b'mrw 0xE000101C\r\n': + return int(num) + + return 0 + + + def initSymbols(self, elf, readelf='arm-none-eabi-readelf'): + proc = subprocess.Popen([readelf, '-s', elf], stdout=subprocess.PIPE) + for line in proc.stdout.readlines(): + field = line.split() + # for i,txt in enumerate(field): + # print("{}, {}".format(i, txt)) + try: + if field[3] == b'FUNC': + addr = int(field[1], 16) - 1 # For some reason readelf dumps the func addr off by 1 + func = field[7] + size = int(field[2]) + if addr not in self.indexes: + self.table.append((addr, func, size)) + self.indexes.add(addr) + except IndexError: + pass + + self.table.sort() + self.addrs = [ x for (x, y, z) in self.table ] + + + def func(self, pc): + + if pc == 0 or pc == 0xFFFFFFFF: + return ('', 0) + + i = bisect_right(self.addrs, pc) + if i: + addr, symb, size = self.table[i-1] + if pc >= addr and pc <= addr + size: + return (symb, addr) + + return ('', 0) + + +if __name__ == '__main__': + + sampler = OpenOCDCMSampler('localhost', 4444) + sampler.initSymbols(sys.argv[1]) + + total = 0 + countmap = { } + pcmap = { } + start = time.time() + + try: + while True: + pc = sampler.getpc() + + if pc in pcmap: + pcmap[pc] += 1 + else: + pcmap[pc] = 1 + + func, addr = sampler.func(pc) + + if not addr: + continue + + if func in countmap: + countmap[func] += 1 + total += 1 + else: + countmap[func] = 1 + total += 1 + + cur = time.time() + if cur - start > 1.0: + tmp = sorted(countmap.items(), key=operator.itemgetter(1), reverse=True) + for k, v in tmp: + # print('{:05.2f}% {}'.format((v * 100.) / total, k)) + print('{:06.2f} clocks : {}'.format((v * 8192) / total, k)) + start = cur + print('{} Samples'.format(total)) + print('') + + except KeyboardInterrupt: + pcmap = sorted(pcmap.items(), key=operator.itemgetter(1), reverse=True) + pcmap = [(hex(addr), count) for addr, count in pcmap] diff --git a/LICENSE.md b/LICENSE.md new file mode 100644 index 00000000..977309e4 --- /dev/null +++ b/LICENSE.md @@ -0,0 +1,21 @@ +MIT License + +Copyright (c) 2016-2018 ODrive Robotics + +Permission is hereby granted, free of charge, to any person obtaining a copy +of this software and associated documentation files (the "Software"), to deal +in the Software without restriction, including without limitation the rights +to use, copy, modify, merge, publish, distribute, sublicense, and/or sell +copies of the Software, and to permit persons to whom the Software is +furnished to do so, subject to the following conditions: + +The above copyright notice and this permission notice shall be included in all +copies or substantial portions of the Software. + +THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR +IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, +FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE +AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER +LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, +OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE +SOFTWARE. diff --git a/analysis/thermistors.py b/analysis/thermistors.py index 5a5c904c..2a3792a9 100644 --- a/analysis/thermistors.py +++ b/analysis/thermistors.py @@ -5,7 +5,7 @@ import numpy as np Rload = 3300 R_25 = 10000 T_25 = 25 + 273.15 #Kelvin -Beta = 3380 +Beta = 3434 Tmin = 0 Tmax = 140 diff --git a/docs/Gemfile.lock b/docs/Gemfile.lock index 20e81d61..1c6d972e 100644 --- a/docs/Gemfile.lock +++ b/docs/Gemfile.lock @@ -221,7 +221,7 @@ GEM ruby-enum (0.7.2) i18n ruby_dep (1.5.0) - rubyzip (1.2.1) + rubyzip (1.2.2) safe_yaml (1.0.4) sass (3.5.6) sass-listen (~> 4.0.0) diff --git a/docs/TrapTrajPosVel.PNG b/docs/TrapTrajPosVel.PNG new file mode 100644 index 00000000..59c5bbe9 Binary files /dev/null and b/docs/TrapTrajPosVel.PNG differ diff --git a/docs/ascii-protocol.md b/docs/ascii-protocol.md index 951ec214..51ff18ea 100644 --- a/docs/ascii-protocol.md +++ b/docs/ascii-protocol.md @@ -7,7 +7,7 @@ * **Windows:** Use the Zadig utility to set the ODrive's driver to "usbser". Windows will then make the device available as COM port. You can use [PuTTY](https://www.chiark.greenend.org.uk/~sgtatham/putty/) to manually send commands or open the COM port using your favorite programming language * **Linux/macOS:** Run `/dev/tty*` to list all serial ports. The ODrive will show up as `/dev/ttyACM0` on Linux and `/dev/tty.usbmodem[...]` on macOS. Once you know the name, you can use `screen /dev/ttyACM0` (with the correct name) to send commands manually or open the device using your favorite programming language. Serial ports on Unix can be opened, written to and read from like a normal file. * **Via UART:** Connect the ODrive's TX (GPIO1) to your host's RX. Connect your ODrive's RX (GPIO2) to your host's TX. The logic level of the ODrive is 3.3V. - * **Arduino:** You can use the [ODrive Arduino library](https://github.com/madcowswe/ODriveArduino) to talk to the ODrive. + * **Arduino:** You can use the [ODrive Arduino library](https://github.com/madcowswe/ODrive/tree/master/Arduino/ODriveArduino) to talk to the ODrive. * **Windows/Linux/macOS:** You can use an FTDI USB-UART cable to connect to the ODrive. ## Command format diff --git a/docs/commands.md b/docs/commands.md index 7e7fe3da..32b7769d 100644 --- a/docs/commands.md +++ b/docs/commands.md @@ -22,7 +22,7 @@ The current state of an axis is indicated by `.current_state`. The user ca 1. `AXIS_STATE_IDLE` Disable motor PWM and do nothing. 2. `AXIS_STATE_STARTUP_SEQUENCE` Run the [startup procedure](#startup-procedure). - 3. `AXIS_STATE_FULL_CALIBRATION_SEQUENCE` Run motor calibration and then encoder offset calibration (or encoder index search if `.encoder.use_index` is `True`). + 3. `AXIS_STATE_FULL_CALIBRATION_SEQUENCE` Run motor calibration and then encoder offset calibration (or encoder index search if `.encoder.config.use_index` is `True`). 4. `AXIS_STATE_MOTOR_CALIBRATION` Measure phase resistance and phase inductance of the motor. * To store the results set `.motor.config.pre_calibrated` to `True` and [save the configuration](#saving-the-configuration). After that you don't have to run the motor calibration on the next start up. * This modifies the variables `.motor.config.phase_resistance` and `.motor.config.phase_inductance`. diff --git a/docs/control.md b/docs/control.md index f0b2da1d..fd04ac6d 100644 --- a/docs/control.md +++ b/docs/control.md @@ -2,7 +2,7 @@ The motor controller is a cascaded style position, velocity and current control loop, as per the diagram below. When the control mode is set to position control, the whole loop runs. When running in velocity control mode, the position control part is removed and the velocity command is fed directly in to the second stage input. In current control mode, only the current controller is used. -![Cascaded pos vel I loops](https://static1.squarespace.com/static/58aff26de4fcb53b5efd2f02/t/5b66284a0e2e72aae8818d64/1533421649405/CascadedController.png?format=2500w) +![Cascaded pos vel I loops](https://github.com/madcowswe/ODrive/blob/master/docs/controller_with_ff.png?raw=true) ### Position loop: The position controller is a P loop with a single proportional gain. diff --git a/docs/controller_with_ff.png b/docs/controller_with_ff.png new file mode 100644 index 00000000..212b1f26 Binary files /dev/null and b/docs/controller_with_ff.png differ diff --git a/docs/developer-guide.md b/docs/developer-guide.md index 30a20543..8083e16b 100644 --- a/docs/developer-guide.md +++ b/docs/developer-guide.md @@ -5,7 +5,7 @@ As such it assumes that you know things like how to use Git, what a compiler is, The official releases are maintained on the `master` branch. However since you are a developer, you are encouraged to use the `devel` branch, as it contains the latest features. -The project is under active development, so make sure to check the [Changelog](CHANGELOG.md) to keep track of updates. +The project is under active development, so make sure to check the [Changelog](../CHANGELOG.md) to keep track of updates. ### Table of contents @@ -80,7 +80,9 @@ __Note__: make sure these programs are not only installed but also added to your Some instructions in this document may assume that you're using a bash command prompt, such as the Windows 10 built-in bash or [Git](https://git-scm.com/download/win) bash. -* [ARM compiler](https://developer.arm.com/open-source/gnu-toolchain/gnu-rm/downloads) __Note__: After installing, create an environment variable named `ARM_GCC_ROOT` whose value is the path you installed to. e.g. `C:\Program Files (x86)\GNU Tools Arm Embedded\7 2018-q2-update`. This variable is used to locate include files for the c/c++ Visual Studio Code extension. +* [ARM compiler](https://developer.arm.com/open-source/gnu-toolchain/gnu-rm/downloads) + * __Note 1__: After installing, create an environment variable named `ARM_GCC_ROOT` whose value is the path you installed to. e.g. `C:\Program Files (x86)\GNU Tools Arm Embedded\7 2018-q2-update`. This variable is used to locate include files for the c/c++ Visual Studio Code extension. + * __Note 2__: 8-2018-q4-major seems to have a bug on Windows. Please use 7-2018-q2-update. * [Tup](http://gittup.org/tup/index.html) * [Make for Windows](http://gnuwin32.sourceforge.net/packages/make.htm) * [OpenOCD](http://gnuarmeclipse.github.io/openocd/install/). Also follow the instructions on the ST-LINK/V2 drivers. @@ -144,33 +146,53 @@ For working with the ODrive code you don't need an IDE, but the open-source IDE

## STM32CubeMX - This project uses the STM32CubeMX tool to generate startup code and to ease the configuration of the peripherals. You can download it from [here](http://www2.st.com/content/st_com/en/products/development-tools/software-development-tools/stm32-software-development-tools/stm32-configurators-and-code-generators/stm32cubemx.html?icmp=stm32cubemx_pron_pr-stm32cubef2_apr2014&sc=stm32cube-pr2). All CubeMX related files are in `Firmware/Board/v3`. You will likely want the pinout for this process. It is available [here](https://docs.google.com/spreadsheets/d/1QXDCs1IRtUyG__M_9WruWOheywb-GhOwFtfPcHuN2Fg/edit#gid=404444347). -### Generate code +### Maintaining modified generated code +When generating the code, STM32CubeMX will nuke everything except some special sections that they provide. These sections are marked like `USER CODE BEGIN`...`USER CODE END`. +We used to try to make sure all edits we made to the generated code would only go in these sections, so some code structrure may reflect that. +However over time we realized this will not be tenable, so instead we use git to rebase all changes of the generated code whenever we need to regenerate it. +We use two special branches that will help us to do this, they are `STM32CubeMX-start` and `STM32CubeMX-end`. +How to use these is shown in the following example. + +**Note**: Due to how this rebasing is done, all development that changes the generated code should be done directly on `STM32CubeMX-end`, and not based on `devel`, then follow step 4 below to carry them over to your feature branch. If you did some changes to the generated code based from `devel`, you need to cherry pick just those changes over to `STM32CubeMX-end`. + +### 1. Ensuring a clean slate +* We do all changes to the STM32CubeMX config and regenerate the code on top of `STM32CubeMX-start`. + * `git checkout STM32CubeMX-start` * Run stm32cubeMX and load the `Firmware/Board/v3/Odrive.ioc` project file. -* Press `Project -> Generate code` + * If the tool asks if you wish to migrate to a new version, choose to migrate. +* Without changing any settings, press `Project -> Generate code`. * You may need to let it download some drivers and such. -* After generating/updating the code, some minor patches need to be applied. To do this, run: - `git apply Firmware/Board/v3/*.patch` -* Run `git config --local core.autocrlf input`. This will tell git that all files should be checked in with LF endings (CubeMX generates CRLF endings). -* `git status` will still claim that many files are modified but the actual diff (using `git diff`) is empty (apart from all the line ending warnings). +* STM32CubeMX may now have a newer version of some of the libraries, so there may be changes to the generated code even though we didn't change any settings. We need to check that everything is still working, and hence check in the changes: +* `git config --local core.autocrlf input` - This will tell git that all files should be checked in with LF endings (CubeMX generates CRLF endings). +* `git diff` - Ignore the pile of line ending warnings. +* If you feel qualified: you can now ispect if CubeMX introduced something stupid. If there were any changes, and they look acceptable, we should commit them: + * `git commit -am "Run STM32CubeMX v1.21"` - Replace with actual version of CubeMX -### Generating patchfiles -If you made changes to CubeMX generated files outside of the `USER CODE BEGIN`...`USER CODE END` sections and contribute them back, please add a patch file so that the next person who runs CubeMX doesn't run into problems. +### 2. Making changes to the STM32CubeMX config +* After completing the above steps, make sure the working directory is clean: + * `git status` should include "nothing to commit, working tree clean" +* Make your changes in STM32CubeMX, save the project and generate the code. (`Project -> Generate code`) +* `git diff` - Check that the introduced changes are as expected +* If everything looks ok, you can commit your changes. -CubeMX will reset everything outside these sections to the original state; we will capturing into a patch file the changes required to undo this resetting. -* Make sure your current desired state is committed. -* Make a new temporary branch: `git checkout -b cubemx_temp` -* Run the CubeMX code generation as described in the previous section, including applying previous patches. -* The diff will now _not_ be empty since CubeMX reset your changes. -* Stage this state and commit it with a message like "CubeMX reset my changes". -* Run `git revert HEAD` to undo the resetting action CubeMX's regeneration had. This is the commit which you will export, so write a meaningful commit message. -* Run `git format-patch HEAD~1` to export the commit as patch file. -* Check out your previous branch and then force-delete the temporary branch: `git branch -D cubemx_temp` -* Move the patch file to `Firmware/Board/v3/` and add it in a new commit. +### 3. Rebasing the modifications to the generated code +* `git checkout STM32CubeMX-end` +* `git rebase STM32CubeMX-start` +* Make sure the rebase finishes, fixing any conflicts that may arise + +### 4. Merge new STM32CubeMX code to your feature branch +Simply merge the new state at `STM32CubeMX-end` into your feature branch. +* `git checkout your-feature` +* `git merge STM32CubeMX-end` + +### 5. Pushing back upstream +* Generate a PR like normal for your feature. +* Make sure youhave pushed to the `STM32CubeMX-start` and `STM32CubeMX-end` branches on your fork. +* Make a note in your PR to the maintainer that they need to update the STM32CubeMX branches when they merge the PR.

## Troubleshooting diff --git a/docs/getting-started.md b/docs/getting-started.md index 0127efad..1a346bd8 100644 --- a/docs/getting-started.md +++ b/docs/getting-started.md @@ -16,6 +16,7 @@ permalink: / - [Start `odrivetool`](#start-odrivetool) - [Configure M0](#configure-m0) - [Position control of M0](#position-control-of-m0) +- [Other control modes](#other-control-modes) - [What's next?](#whats-next) @@ -39,7 +40,7 @@ permalink: / -* A power supply (12V-24V for the 24V board variant, 12V-48V for the 48V board variant). A battery is also fine. +* A power supply (12V-24V for the 24V board variant, 12V-48V for the 48V board variant). A battery is also fine. Some advice on choosing a power supply can be found [here](https://things-in-motion.blogspot.com/2018/12/how-to-select-right-power-source-for.html).
What voltage variant do I have?
On all ODrives shipped July 2018 or after have a silkscreen label clearly indicating the voltage variant. @@ -55,14 +56,19 @@ All non-power I/O is 3.3V output and 5V tolerant on input, on ODrive v3.3 and ne ### Wiring up the motors * Connect the motor phases into the 3-phase screw terminals. It is not recommended to use a clip-on connector such as an alligator clip, as this can cause issues with the phase resistance/inductance measurements. -* Connect the power source to the DC terminals. Make sure to pay attention to the polarity. -* Do not apply power just yet. ### Wiring up the encoders Connect the encoder(s) to J4. The A,B phases are required, and the Z (index pulse) is optional. The A,B and Z lines have 3.3k pull up resistors, for use with open-drain encoder outputs. For single ended push-pull signals with weak drive current (\<4mA), you may want to desolder the pull-ups. ![Image of ODrive all hooked up](https://docs.google.com/drawings/d/e/2PACX-1vTCD0P40Cd-wvD7Fl8UYEaxp3_UL81oI4qUVqrrCJPi6tkJeSs2rsffIXQRpdu6rNZs6-2mRKKYtILG/pub?w=1716&h=1281) +### Safety & Power UP +
+ Always think safety before powering up the ODrive if motors are attached. Consider what might happen if the motor spins as soon as power is applied. +
+* Unlike some devices, the ODrive does not recieve power over the USB port so the 24/48 volt power input is required even just to communicate with it using USB. It is ok to power up the ODrive before or after connecting the USB cable. +* To power up the ODrive, connect the power source to the DC terminals. Make sure to pay attention to the polarity. A small spark is normal. This is caused by the capacitors charging up. + ## Downloading and Installing Tools Most instructions in this guide refer to a utility called `odrivetool`, so you should install that first. @@ -129,10 +135,10 @@ Try step 5 again ## Firmware **ODrive v3.5 and later**
-Your board should come preflashed with firmware. If you run into problems, follow the instructions [here](odrivetool.md#device-firmware-update) on the DFU procedure before you continue.
+Your board should come preflashed with firmware. If you run into problems, follow the instructions [here](odrivetool.md#device-firmware-update) on the DFU procedure before you continue. **ODrive v3.4 and earlier**
-Your board does **not** come preflashed with any firmware. Follow the instructions [here](odrivetool.md#device-firmware-update) on the STP Link procedure before you continue. +Your board does **not** come preflashed with any firmware. Follow the instructions [here](odrivetool.md#device-firmware-update) on the STP Link procedure before you continue. ## Start `odrivetool` To launch the main interactive ODrive tool, type `odrivetool` Enter. Connect your ODrive and wait for the tool to find it. Now you can, for instance type `odrv0.vbus_voltage` Enter to inpect the boards main supply voltage. @@ -165,7 +171,7 @@ For instance, to set the current limit of M0 to 10A you would type: `odrv0.axis0 **Current limit**
`odrv0.axis0.motor.config.current_lim` [A]. -The default current limit, for safety reasons, is set to 10A. This is quite weak, but good for making sure the drive is stable. Once you have tuned the oDrive, you can increase this to 75A to increase performance. Note that above 75A, you must change the current amplifier gains. You do this by requesting a different current range. i.e. for 90A on M0: `odrv0.axis0.motor.config.requested_current_range = 90` [A], then save the configuration and reboot as the gains are written out to the DRV (MOSFET driver) only during startup. +The default current limit, for safety reasons, is set to 10A. This is quite weak, but good for making sure the drive is stable. Once you have tuned the oDrive, you can increase this to 60A to increase performance. Note that above 60A, you must change the current amplifier gains. You do this by requesting a different current range. i.e. for 90A on M0: `odrv0.axis0.motor.config.requested_current_range = 90` [A], then save the configuration and reboot as the gains are written out to the DRV (MOSFET driver) only during startup. *Note: The motor current and the current drawn from the power supply is not the same in general. You should not look at the power supply current to see what is going on with the motor current.*
Ok, so tell me how it actually works then...
@@ -188,6 +194,7 @@ This is the resistance of the brake resistor. If you are not using it, you may s `odrv0.axis0.motor.config.pole_pairs` This is the number of **magnet poles** in the rotor, **divided by two**. To find this, you can simply count the number of permanent magnets in the rotor, if you can see them. _Note: this is not the same as the number of coils in the stator._ If you can't see them, try sliding a magnet around the rotor, and counting how many times it stops. This will be the number of **pole pairs**. If you use a magnetic piece of metal instead of a magnet, you will get the number of **magnet poles**. + `odrv0.axis0.motor.config.motor_type` This is the type of motor being used. Currently two types of motors are supported: High-current motors (`MOTOR_TYPE_HIGH_CURRENT`) and gimbal motors (`MOTOR_TYPE_GIMBAL`).
Which motor_type to choose?
@@ -241,16 +248,77 @@ Let's get motor 0 up and running. The procedure for motor 1 is exactly the same, 2. Type `odrv0.axis0.requested_state = AXIS_STATE_CLOSED_LOOP_CONTROL` Enter. From now on the ODrive will try to hold the motor's position. If you try to turn it by hand, it will fight you gently. That is unless you bump up `odrv0.axis0.motor.config.current_lim`, in which case it will fight you more fiercely. 3. Send the motor a new position setpoint. `odrv0.axis0.controller.pos_setpoint = 10000` Enter. The units are in encoder counts. -### Other control modes -The ODrive also supports velocity control and current (torque) control. +## Other control modes +The default control mode is unfiltered position control in the absolute encoder reference frame. You may wish to use a controlled trajectory instead. Or you may wish to control position in a circular frame to allow continous rotation forever without growing the numeric value of the setpoint too large. +You may also wish to control velocity (directly or with a ramping filter). +You can also directly control the current of the motor, which is proportional to torque. -**Velocity control**
-Set `odrv0.axis0.controller.config.control_mode = CTRL_MODE_VELOCITY_CONTROL`. -You can now control the velocity with `odrv0.axis0.controller.vel_setpoint = 5000` [count/s]. +- [Trajectory control](#trajectory-control) +- [Circular position control](#circular-position-control) +- [Velocity control](#velocity-control) +- [Ramped velocity control](#ramped-velocity-control) +- [Current control](#current-control) -**Current control**
-Set `odrv0.axis0.controller.config.control_mode = CTRL_MODE_CURRENT_CONTROL`. -You can now control the current with `odrv0.axis0.controller.current_setpoint = 3` [A]. + +### Trajectory control +Set `axis.controller.config.control_mode = CTRL_MODE_TRAJECTORY_CONTROL`.
+This mode lets you smoothly accelerate, coast, and decelerate the axis from one position to another. With raw position control, the controller simply tries to go to the setpoint as quickly as possible. Using a trajectory lets you tune the feedback gains more aggressively to reject disturbance, while keeping smooth motion. + +![Taptraj](TrapTrajPosVel.PNG)
+In the above image blue is position and orange is velocity. + +#### Parameters +``` +..trap_traj.config.vel_limit = +..trap_traj.config.accel_limit = +..trap_traj.config.decel_limit = +..trap_traj.config.A_per_css = +``` + +`vel_limit` is the maximum planned trajectory speed. This sets your coasting speed.
+`accel_limit` is the maximum acceleration in counts / sec^2
+`decel_limit` is the maximum deceleration in counts / sec^2
+`A_per_css` is a value which correlates acceleration (in counts / sec^2) and motor current. It is 0 by default. It is optional, but can improve response of your system if correctly tuned. Keep in mind this will need to change with the load / mass of your system. + +All values should be strictly positive (>= 0). + +Keep in mind that you must still set your safety limits as before. I recommend you set these a little higher ( > 10%) than the planner values, to give the controller enough control authority. +``` +..motor.config.current_lim = +..controller.config.vel_limit = +``` + +#### Usage +Use the `move_to_pos` function to move to an absolute position: +``` +..controller.move_to_pos() +``` + +### Circular position control + +To enable Circular position control, set `axis.controller.config.setpoints_in_cpr = True` + +This mode is useful for continuos incremental position movement. For example a robot rolling indefinitely, or an extruder motor or conveyor belt moving with controlled increments indefinitely. +In the regular position mode, the `pos_setpoint` would grow to a very large value and would lose precision due to floating point rounding. + +In this mode, the controller will try to track the position within only one turn of the motor. Specifically, `pos_setpoint` is expected in the range `[0, cpr-1]`, where `cpr` is the number of encoder counts in one revolution. If the `pos_setpoint` is incremented to outside this range (say via step/dir input), it is automatically wrapped around into the correct value. +Note that in this mode `encoder.pos_cpr` is used for feedback in stead of `encoder.pos_estimate`. + +If you try to increment the axis with a large step in one go that exceeds `cpr/2` steps, the motor will go to the same angle around the wrong way. This is also the case if there is a large disturbance. If you have an application where you would like to handle larger steps, you can use a virtual CPR that is an integer times larger than your encoder's actual CPR. Set `encoder.config.cpr = N * your_enc_cpr`, where N is some integer. Choose N to give you an appropriate circular space for your application. + +### Velocity control +Set `axis.controller.config.control_mode = CTRL_MODE_VELOCITY_CONTROL`.
+You can now control the velocity with `axis.controller.vel_setpoint = 5000` [count/s]. + +### Ramped velocity control +Set `axis.controller.config.control_mode = CTRL_MODE_VELOCITY_CONTROL`.
+Set the velocity ramp rate (acceleration): `axis.controller.config.vel_ramp_rate = 2000` [counts/s^2]
+Activate the ramped velocity mode: `axis.controller.vel_ramp_enable = True`.
+You can now control the velocity with `axis.controller.vel_ramp_target = 5000` [count/s]. + +### Current control +Set `axis.controller.config.control_mode = CTRL_MODE_CURRENT_CONTROL`.
+You can now control the current with `axis.controller.current_setpoint = 3` [A]. *Note: There is no velocity limiting in current control mode. Make sure that you don't overrev the motor, or exceed the max speed for your encoder.* diff --git a/docs/hoverboard.md b/docs/hoverboard.md index be35e74d..9641ae6d 100644 --- a/docs/hoverboard.md +++ b/docs/hoverboard.md @@ -8,9 +8,9 @@ Each step is acompanied by some explanation so hopefully you can carry over some ### Hoverboard motor wiring Hoverboard motors come with three motor phases (usually colored yellow, blue, green) which are thicker, and a set of 5 thinner wires for the hall sensor feedback (usually colored red, yellow, blue, green, black). -You may wire the motor phases in any order into a motor connector on the ODrive, as we will calibrate the phase alignment later anyway. Wire the hall feedback into the ODrive J2 conenctor (make sure that the motor channel number matches) as follows: +You may wire the motor phases in any order into a motor connector on the ODrive, as we will calibrate the phase alignment later anyway. Wire the hall feedback into the ODrive J4 conenctor (make sure that the motor channel number matches) as follows: -| Hall wire | J2 signal | +| Hall wire | J4 signal | |-----------|-----------| | Red | 5V | | Yellow | A | @@ -18,6 +18,8 @@ You may wire the motor phases in any order into a motor connector on the ODrive, | Green | Z | | Black | GND | +Note: In order to ber compatible with encoder inputs, the ODrive doesn't have any filtering capacitors on the pins where the hall sensors connect. Therefore to get a reliable hall signal, it is recommended that you add some filter capacitors to these pins. You can see instructions [here](https://discourse.odriverobotics.com/t/encoder-error-error-illegal-hall-state/1047/7?u=madcowswe). + ### Hoverboard motor configuration Standard 6.5 inch hoverboard hub motors have 30 permanent magnet poles, and thus 15 pole pairs. If you have a different motor you need to count the magnets or have a reliable datasheet for this information. @@ -118,7 +120,7 @@ odrv0.axis0.requested_state = AXIS_STATE_IDLE Hopefully you got your motor to spin! Feel free to repeat all of the above for the other axis if appropriate. ### PWM input -If you want to drive your hoverboard wheels around with an RC remote contro you can use the [RC PWM input](interfaces.md#rc-pwm-input). There is more information in that link. +If you want to drive your hoverboard wheels around with an RC remote control you can use the [RC PWM input](interfaces.md#rc-pwm-input). There is more information in that link. Lets use GPIO 3/4 for the velocity inputs so that we don't have to disable UART. Then let's map the full stick range of these inputs to some suitable velocity setpoint range. We also have to reboot to activate the PWM input. @@ -159,6 +161,9 @@ odrv0.axis0.requested_state = AXIS_STATE_CLOSED_LOOP_CONTROL odrv0.axis1.requested_state = AXIS_STATE_CLOSED_LOOP_CONTROL ``` +### Safety +Be sure to setup the Failsafe feature on your RC Receiver so that if connection is lost between the remote and the receiver, the receiver outputs 0 and 0 for the velocity setpoint of both axes (or whatever is safest for your configuration). Also note that if the receiver turns off (loss of power, etc) or if the signal from the receiver to the ODrive is lost (wire comes unplugged, etc), the ODrive will continue the last commanded velocity setpoint. There is currently no timeout function in the ODrive for PWM inputs. + ### Automatic startup Try to reboot and then activate AXIS_STATE_CLOSED_LOOP_CONTROL on both axis. Check that everything is operational and works as expected. If so, you can now make the ODrive turn on the motor power automatically after booting. This is useful if you are going to be running the ODrive without a PC or other logic board. diff --git a/docs/interfaces.md b/docs/interfaces.md index ba6ccfb0..3f5a7dbd 100644 --- a/docs/interfaces.md +++ b/docs/interfaces.md @@ -32,7 +32,11 @@ The ODrive can be controlled over various ports and protocols. If you're comfort (+) on ODrive v3.4 and earlier
(*) ODrive v3.5 and later -ODrive v3.3 and onward have 5V tolerant GPIO pins. +Notes: +* You must also connect GND between ODrive and your other board. +* ODrive v3.3 and onward have 5V tolerant GPIO pins. +* ODrive v3.5 and later have some noise supression filters on the default step/dir pins +* You can change the step/dir pins using `axis.config._gpio_pin`. ### Pin function priorities 1. PWM in, if enabled. Disabled by default. @@ -89,7 +93,7 @@ There is an Arduino library that gives some expamples on how to use the ASCII pr This is the simplest possible way of controlling the ODrive. It is also the most primitive and fragile one. So don't use it unless you must interoperate with other hardware that you don't control. Pinout: -* Step/dir signals: see [Pinout](#pinout) above. +* Step/dir signals: see [Pinout](#pinout) above. Note in that section how to reassign the pins. * GND: you must connect the grounds of the devices together. Use any GND pin on J3 of the ODrive. To enable step/dir mode for the GPIO, set `.config.enable_step_dir` to true for each axis that you wish to use this on. @@ -124,6 +128,8 @@ As an example, we'll configure GPIO4 to control the angle of axis 0. We want the ``` 5. With the ODrive powered off, connect the RC receiver ground to the ODrive's GND and one of the RC receiver signals to GPIO4. You may try to power the receiver from the ODrive's 5V supply if it doesn't draw too much power. Power up the the RC transmitter. You should now be able to control axis 0 from one of the RC sticks. +Be sure to setup the Failsafe feature on your RC Receiver so that if connection is lost between the remote and the receiver, the receiver outputs 0 for the velocity setpoint of both axes (or whatever is safest for your configuration). Also note that if the receiver turns off (loss of power, etc) or if the signal from the receiver to the ODrive is lost (wire comes unplugged, etc), the ODrive will continue the last commanded velocity setpoint. There is currently no timeout function in the ODrive for PWM inputs. + ## Ports Note: when you use an existing library you don't have to deal with the specifics described in this section. diff --git a/docs/odrivetool.md b/docs/odrivetool.md index 01670257..c00d5bc3 100644 --- a/docs/odrivetool.md +++ b/docs/odrivetool.md @@ -123,11 +123,52 @@ You can use the DfuSe app from ST. 1. Congratulations your ODrive should now be flashed; you can now quit DfuSeDemo. 1. Turn off the power to the ODrive and set the DIP switch back to RUN mode. -#### MacOS or Linux -**This section needs more detail. Please consider adding detail if you got it to work.** -You may be able to use [dfu-util](http://dfu-util.sourceforge.net/) to upgrade the firmware. You will need to convert the .hex file to a .dfu file. You may be able to do it with the python script [dfu-convert](https://github.com/plietar/dfuse-tool/blob/master/dfu-convert) or the c program [hex2dfu](https://github.com/encedo/hex2dfu). +#### Linux +Install `dfu-util`: +```text +sudo apt install dfu-util +``` -You probably need to force DFU mode, as per the instructions above. +Force DFU mode, as per the instructions above. +In the Firmware directory, after finishing building the firmware: +```text +sudo dfu-util -a 0 -s 0x08000000 -D build/ODriveFirmware.bin +``` + +#### macOS + +First, you need to install the arm development tools to copy the binary into the appropriate format. + +```text +$ brew cask install gcc-arm-embedded +``` + +Then convert the binary to .bin format + +```text +$ arm-none-eabi-objcopy -O binary ODriveFirmware_v3.5-48V.elf ODriveFirmware_v3.5-48V.bin +``` + +Install `dfu-util`: + +```text +$ sudo port install dfu-util # via MacPorts; for HomeBrew use "brew install dfu-util" +``` + +Find the correct device serial number to use: + +```text +$ dfu-util --list # list the DFU capable devices +[...] +Found DFU: [0483:df11] ver=2200, devnum=5, cfg=1, intf=0, path="20-2", alt=0, + name="@Internal Flash /0x08000000/04*016Kg,01*064Kg,07*128Kg", serial="388237123123" +``` + +Finally, flash the firmware using the found serial number: + +```text +$ sudo dfu-util -S 388237123123 -a 0 -s 0x08000000 -D ODriveFirmware_v3.5-48V.bin +``` ## Flashing with an STLink diff --git a/docs/troubleshooting.md b/docs/troubleshooting.md index c05c7f92..80e4475a 100644 --- a/docs/troubleshooting.md +++ b/docs/troubleshooting.md @@ -14,24 +14,13 @@ Table of Contents: ## Error codes -If your ODrive is not working as expected, run `odrivetool` and type `hex(.error)` Enter where `` is the axis that isn't working. This will display a [hexadecimal](https://en.wikipedia.org/wiki/Hexadecimal) representation of the error code. Each bit represents one error flag. - -
Example
-Say you got this error output: -```python -In [1]: hex(odrv0.axis0.error) -Out[1]: '0x6' -``` - -Written in binary, the number `0x6` corresponds to `110`, that means bits 1 and 2 are set (counting starts at 0). -Looking at the reference below, this means that both `ERROR_DC_BUS_UNDER_VOLTAGE` and `ERROR_DC_BUS_OVER_VOLTAGE` occurred. -
- -The axis error may say that some other component has failed. Say it reports `ERROR_ENCODER_FAILED`, then you need to go check the encoder error: `hex(.encoder.error)`. +If your ODrive is not working as expected, run `odrivetool` and type `dump_errors(odrv0)` Enter. This will dump a list of all the errors that are present. To also clear all the errors, you can run `dump_errors(odrv0, True)`. +The following sections will give some guidance on the most common errors. You may also check the code for the full list of errors: * Axis error flags defined [here](../Firmware/MotorControl/axis.hpp). * Motor error flags defined [here](../Firmware/MotorControl/motor.hpp). * Encoder error flags defined [here](../Firmware/MotorControl/encoder.hpp). +* Controller error flags defined [here](../Firmware/MotorControl/controller.hpp). * Sensorless estimator error flags defined [here](../Firmware/MotorControl/sensorless_estimator.hpp). ## Common Axis Errors @@ -70,7 +59,8 @@ Some motors will have a considerably different phase resistance and inductance t In general, you need ```text -resistance_calib_max_voltage > calibration_current * phase_resistance`. +resistance_calib_max_voltage > calibration_current * phase_resistance +resistance_calib_max_voltage < 0.5 * vbus_voltage ``` * `ERROR_DRV_FAULT = 0x0008` @@ -84,6 +74,12 @@ power supply of the DRV8301 gate driver chips, thus tripping its under-voltage f To resolve this issue you can limit the M0 current to 40A. The lowest current at which the DRV fault was observed is 45A on one test motor and 50A on another test motor. Refer to [this post](https://discourse.odriverobotics.com/t/drv-fault-on-odrive-v3-4/558) for instructions for a hardware fix. +* `ERROR_MODULATION_MAGNITUDE = 0x0080` + +The bus voltage was insufficent to push the requested current through the motor. Reduce `motor.config.calibration_current` and/or `motor.config.current_lim`, for errors at calibration-time and closed loop control respectively. + +For gimbal motors, it is recommended to set the calibration_current and current_lim to half your bus voltage, or less. + ## Common Encoder Errors * `ERROR_CPR_OUT_OF_RANGE = 0x02` diff --git a/tools/odrive/enums.py b/tools/odrive/enums.py index ec374bdc..fc5439bd 100644 --- a/tools/odrive/enums.py +++ b/tools/odrive/enums.py @@ -13,17 +13,47 @@ AXIS_STATE_CLOSED_LOOP_CONTROL = 8 AXIS_STATE_LOCKIN_SPIN = 9 AXIS_STATE_ENCODER_DIR_FIND = 10 -AXIS_ERROR_NONE = 0 -AXIS_ERROR_INVALID_STATE = 1 -#AXIS_ERROR_DC_BUS_UNDER_VOLTAGE = 2 -#AXIS_ERROR_DC_BUS_OVER_VOLTAGE = 3 -#AXIS_ERROR_CURRENT_MEASUREMENT_TIMEOUT = 4 -#AXIS_ERROR_CONTROL_LOOP_TIMEOUT = 5 -#AXIS_ERROR_MOTOR_FAILED = 6 -#AXIS_ERROR_SENSORLESS_ESTIMATOR_FAILED = 7 -#AXIS_ERROR_ENCODER_FAILED = 8 -#AXIS_ERROR_CONTROLLER_FAILED = 9 -#AXIS_ERROR_POS_CTRL_DURING_SENSORLESS = 10 +class errors: + class axis: + ERROR_NONE = 0x00 + ERROR_INVALID_STATE = 0x01 #