Library used to control ST Nucleo Evaluation board IHM12A1, based on STSPIN240 low voltage dual brush DC motor control driver.

Dependencies:   ST_INTERFACES

Dependents:   motori prova_motore SchedamotoriIHM12A1 prova_motore_duck ... more

Fork of X-NUCLEO-IHM12A1 by ST Expansion SW Team

Brush DC Motor Control Library

Library to handle the X-NUCLEO-IHM12A1 Motor Control Expansion Board based on the STSPIN240 component.

It allows a complete management of the STSPIN240, a low voltage dual brush DC driver, by providing a complete APIs.

The key features of the library are :

  • Configuration of the STSPIN240 (bridges input and enabling signals)
  • Flag interrupt handling (overcurrent and thermal alarms reporting)
  • Handling of up to two bidirectional Brush DC motors
  • Nucleo and expansion board configuration (GPIOs, PWMs, IRQs…)

To use the STSPIN240 driver library, the user first has to call its initialization method which:

  • Setups the required GPIOs to handle the bridges enable pins, the FLAG interrupt which reports overcurrent detection or thermal protection.
  • Loads the driver parameters with initial values configured by the user or with their predefined values from “stspin240_250_target_config.h”, in order to program the PWMs frequency of the bridges inputs, the number of brush DC motors.

Once the initialization is done, the user can modify the driver parameters by calling specific functions to change the numbers of motors or the PWMs frequency.

The user can also write callback functions and attach them to:

  • The flag interrupt handler depending on the actions he wants to perform when an overcurrent or a thermal alarm is reported.
  • The Error handler which is called by the library when it reports an error.

Then, the user can drive the different brush DC motors by requesting to run in a specified direction and by changing the maximal speed. When a motor is requested to run, the corresponding bridge is automatically enabled.

A motion command can be stopped at any moment:

  • Either by a hard stop which immediately stops the motor.
  • Or by a hardHiz command which immediately stops the motor and disables the bridge which is used by the motor.

The library also provides functions to disable or enable the bridges independently from the run or stop commands.

Arduino Connector Compatibility Warning

Using the X-NUCLEO-IHM12A1 expansion board with the NUCLEO-F429ZI requires adopting the following patch:

  • to connect with a wire the PB_3 Nucleo pin to the PWMB expansion board pin.


Board configuration for HelloWorld_IHM12A1 example

/media/uploads/Manu_L/x_nucleo_ihm12a1.jpg

Committer:
Davidroid
Date:
Fri Mar 24 14:06:00 2017 +0000
Revision:
4:07acd6934359
Parent:
Components/stspin240_250/STSpin240_250.cpp@3:b0128df93d26
Child:
6:123d44b9fb9d
Typos corrected.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
davide.aliprandi@st.com 3:b0128df93d26 1 /**
davide.aliprandi@st.com 3:b0128df93d26 2 ******************************************************************************
davide.aliprandi@st.com 3:b0128df93d26 3 * @file STSpin240_250.cpp
davide.aliprandi@st.com 3:b0128df93d26 4 * @author IPC Rennes
davide.aliprandi@st.com 3:b0128df93d26 5 * @version V1.0.0
davide.aliprandi@st.com 3:b0128df93d26 6 * @date April 25th, 2016
Davidroid 4:07acd6934359 7 * @brief STSpin240 motor driver (Dual brush DC motors)
davide.aliprandi@st.com 3:b0128df93d26 8 * @note (C) COPYRIGHT 2016 STMicroelectronics
davide.aliprandi@st.com 3:b0128df93d26 9 ******************************************************************************
davide.aliprandi@st.com 3:b0128df93d26 10 * @attention
davide.aliprandi@st.com 3:b0128df93d26 11 *
davide.aliprandi@st.com 3:b0128df93d26 12 * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
davide.aliprandi@st.com 3:b0128df93d26 13 *
davide.aliprandi@st.com 3:b0128df93d26 14 * Redistribution and use in source and binary forms, with or without modification,
davide.aliprandi@st.com 3:b0128df93d26 15 * are permitted provided that the following conditions are met:
davide.aliprandi@st.com 3:b0128df93d26 16 * 1. Redistributions of source code must retain the above copyright notice,
davide.aliprandi@st.com 3:b0128df93d26 17 * this list of conditions and the following disclaimer.
davide.aliprandi@st.com 3:b0128df93d26 18 * 2. Redistributions in binary form must reproduce the above copyright notice,
davide.aliprandi@st.com 3:b0128df93d26 19 * this list of conditions and the following disclaimer in the documentation
davide.aliprandi@st.com 3:b0128df93d26 20 * and/or other materials provided with the distribution.
davide.aliprandi@st.com 3:b0128df93d26 21 * 3. Neither the name of STMicroelectronics nor the names of its contributors
davide.aliprandi@st.com 3:b0128df93d26 22 * may be used to endorse or promote products derived from this software
davide.aliprandi@st.com 3:b0128df93d26 23 * without specific prior written permission.
davide.aliprandi@st.com 3:b0128df93d26 24 *
davide.aliprandi@st.com 3:b0128df93d26 25 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
davide.aliprandi@st.com 3:b0128df93d26 26 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
davide.aliprandi@st.com 3:b0128df93d26 27 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
davide.aliprandi@st.com 3:b0128df93d26 28 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
davide.aliprandi@st.com 3:b0128df93d26 29 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
davide.aliprandi@st.com 3:b0128df93d26 30 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
davide.aliprandi@st.com 3:b0128df93d26 31 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
davide.aliprandi@st.com 3:b0128df93d26 32 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
davide.aliprandi@st.com 3:b0128df93d26 33 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
davide.aliprandi@st.com 3:b0128df93d26 34 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
davide.aliprandi@st.com 3:b0128df93d26 35 *
davide.aliprandi@st.com 3:b0128df93d26 36 ******************************************************************************
davide.aliprandi@st.com 3:b0128df93d26 37 */
davide.aliprandi@st.com 3:b0128df93d26 38
davide.aliprandi@st.com 3:b0128df93d26 39 /* Includes ------------------------------------------------------------------*/
davide.aliprandi@st.com 3:b0128df93d26 40 #include "STSpin240_250.h"
davide.aliprandi@st.com 3:b0128df93d26 41
davide.aliprandi@st.com 3:b0128df93d26 42 /* Definitions ---------------------------------------------------------------*/
davide.aliprandi@st.com 3:b0128df93d26 43
davide.aliprandi@st.com 3:b0128df93d26 44 /* Error: Access a motor index greater than the one of the current brigde configuration */
davide.aliprandi@st.com 3:b0128df93d26 45 #define STSPIN240_250_ERROR_1 (0xC001)
davide.aliprandi@st.com 3:b0128df93d26 46 /* Error: Use of a bridgeId greater than BRIDGE_B */
davide.aliprandi@st.com 3:b0128df93d26 47 #define STSPIN240_250_ERROR_2 (0xC002)
davide.aliprandi@st.com 3:b0128df93d26 48
davide.aliprandi@st.com 3:b0128df93d26 49 /* Maximum frequency of the PWMs in Hz */
davide.aliprandi@st.com 3:b0128df93d26 50 #define STSPIN240_250_MAX_PWM_FREQ (100000)
davide.aliprandi@st.com 3:b0128df93d26 51
davide.aliprandi@st.com 3:b0128df93d26 52 /* Minimum frequency of the PWMs in Hz */
davide.aliprandi@st.com 3:b0128df93d26 53 #define STSPIN240_250_MIN_PWM_FREQ (2)
davide.aliprandi@st.com 3:b0128df93d26 54
davide.aliprandi@st.com 3:b0128df93d26 55 /* Bridge A */
davide.aliprandi@st.com 3:b0128df93d26 56 #define BRIDGE_A (0)
davide.aliprandi@st.com 3:b0128df93d26 57
davide.aliprandi@st.com 3:b0128df93d26 58 /* Bridge B */
davide.aliprandi@st.com 3:b0128df93d26 59 #define BRIDGE_B (1)
davide.aliprandi@st.com 3:b0128df93d26 60
davide.aliprandi@st.com 3:b0128df93d26 61 /* PWM id for PWM_A */
davide.aliprandi@st.com 3:b0128df93d26 62 #define PWM_A (0)
davide.aliprandi@st.com 3:b0128df93d26 63
davide.aliprandi@st.com 3:b0128df93d26 64 /* PWM id for PWM_B */
davide.aliprandi@st.com 3:b0128df93d26 65 #define PWM_B (1)
davide.aliprandi@st.com 3:b0128df93d26 66
davide.aliprandi@st.com 3:b0128df93d26 67 /* PWM id for PWM_REF */
davide.aliprandi@st.com 3:b0128df93d26 68 #define PWM_REF (2)
davide.aliprandi@st.com 3:b0128df93d26 69
davide.aliprandi@st.com 3:b0128df93d26 70 /* Variables ----------------------------------------------------------------*/
davide.aliprandi@st.com 3:b0128df93d26 71
davide.aliprandi@st.com 3:b0128df93d26 72 /* Number of devices. */
davide.aliprandi@st.com 3:b0128df93d26 73 uint8_t STSpin240_250::numberOfDevices = 0;
davide.aliprandi@st.com 3:b0128df93d26 74 uint8_t STSpin240_250::arrayNbMaxMotorsByConfig[2] = {1,2};
davide.aliprandi@st.com 3:b0128df93d26 75 /* Methods -------------------------------------------------------------------*/
davide.aliprandi@st.com 3:b0128df93d26 76
davide.aliprandi@st.com 3:b0128df93d26 77 /**********************************************************
davide.aliprandi@st.com 3:b0128df93d26 78 * @brief Starts the STSpin240_250 library
davide.aliprandi@st.com 3:b0128df93d26 79 * @param[in] pInit pointer to the initialization data
davide.aliprandi@st.com 3:b0128df93d26 80 * @retval COMPONENT_OK in case of success.
davide.aliprandi@st.com 3:b0128df93d26 81 **********************************************************/
Davidroid 4:07acd6934359 82 status_t STSpin240_250::STSpin240_250_Init(void* pInit)
davide.aliprandi@st.com 3:b0128df93d26 83 {
davide.aliprandi@st.com 3:b0128df93d26 84 /* Standby-reset deactivation */
Davidroid 4:07acd6934359 85 STSpin240_250_Board_ReleaseReset();
davide.aliprandi@st.com 3:b0128df93d26 86
davide.aliprandi@st.com 3:b0128df93d26 87 /* Let a delay after reset */
Davidroid 4:07acd6934359 88 STSpin240_250_Board_Delay(1);
davide.aliprandi@st.com 3:b0128df93d26 89
davide.aliprandi@st.com 3:b0128df93d26 90 if (pInit == 0)
davide.aliprandi@st.com 3:b0128df93d26 91 {
davide.aliprandi@st.com 3:b0128df93d26 92 // Set all registers to their predefined values
davide.aliprandi@st.com 3:b0128df93d26 93 // from powerstep01_target_config.h
Davidroid 4:07acd6934359 94 STSpin240_250_SetDeviceParamsToPredefinedValues();
davide.aliprandi@st.com 3:b0128df93d26 95 }
davide.aliprandi@st.com 3:b0128df93d26 96 else
davide.aliprandi@st.com 3:b0128df93d26 97 {
Davidroid 4:07acd6934359 98 STSpin240_250_SetDeviceParamsToGivenValues((STSpin240_250_init_t *)pInit);
davide.aliprandi@st.com 3:b0128df93d26 99 }
davide.aliprandi@st.com 3:b0128df93d26 100
davide.aliprandi@st.com 3:b0128df93d26 101 /* Initialise input PWM of bridges*/
Davidroid 4:07acd6934359 102 STSpin240_250_SetDualFullBridgeconfig(device_prm.dualBridgeEnabled);
davide.aliprandi@st.com 3:b0128df93d26 103
davide.aliprandi@st.com 3:b0128df93d26 104 return COMPONENT_OK;
davide.aliprandi@st.com 3:b0128df93d26 105 }
davide.aliprandi@st.com 3:b0128df93d26 106
davide.aliprandi@st.com 3:b0128df93d26 107 /**********************************************************
davide.aliprandi@st.com 3:b0128df93d26 108 * @brief Read id
davide.aliprandi@st.com 3:b0128df93d26 109 * @param[in] id pointer to the identifier to be read.
davide.aliprandi@st.com 3:b0128df93d26 110 * @retval COMPONENT_OK in case of success.
davide.aliprandi@st.com 3:b0128df93d26 111 **********************************************************/
Davidroid 4:07acd6934359 112 status_t STSpin240_250::STSpin240_250_ReadId(uint8_t *id)
davide.aliprandi@st.com 3:b0128df93d26 113 {
davide.aliprandi@st.com 3:b0128df93d26 114 *id = deviceInstance;
davide.aliprandi@st.com 3:b0128df93d26 115
davide.aliprandi@st.com 3:b0128df93d26 116 return COMPONENT_OK;
davide.aliprandi@st.com 3:b0128df93d26 117 }
davide.aliprandi@st.com 3:b0128df93d26 118
davide.aliprandi@st.com 3:b0128df93d26 119 /**********************************************************
davide.aliprandi@st.com 3:b0128df93d26 120 * @brief Attaches a user callback to the error Handler.
davide.aliprandi@st.com 3:b0128df93d26 121 * The call back will be then called each time the library
davide.aliprandi@st.com 3:b0128df93d26 122 * detects an error
davide.aliprandi@st.com 3:b0128df93d26 123 * @param[in] callback Name of the callback to attach
davide.aliprandi@st.com 3:b0128df93d26 124 * to the error Hanlder
davide.aliprandi@st.com 3:b0128df93d26 125 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 126 **********************************************************/
Davidroid 4:07acd6934359 127 void STSpin240_250::STSpin240_250_AttachErrorHandler(void (*callback)(uint16_t error))
davide.aliprandi@st.com 3:b0128df93d26 128 {
davide.aliprandi@st.com 3:b0128df93d26 129 errorHandlerCallback = (void (*)(uint16_t error)) callback;
davide.aliprandi@st.com 3:b0128df93d26 130 }
davide.aliprandi@st.com 3:b0128df93d26 131
davide.aliprandi@st.com 3:b0128df93d26 132
davide.aliprandi@st.com 3:b0128df93d26 133 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 134 * @brief Disable the specified bridge
davide.aliprandi@st.com 3:b0128df93d26 135 * @param[in] bridgeId (from 0 for bridge A to 1 for bridge B)
davide.aliprandi@st.com 3:b0128df93d26 136 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 137 * @note Bridge A and bridge B share the same enable pin.
davide.aliprandi@st.com 3:b0128df93d26 138 * When bridge A is disabled, bridge B is disabled and
davide.aliprandi@st.com 3:b0128df93d26 139 * reversely
davide.aliprandi@st.com 3:b0128df93d26 140 **********************************************************/
Davidroid 4:07acd6934359 141 void STSpin240_250::STSpin240_250_DisableBridge(uint8_t bridgeId)
davide.aliprandi@st.com 3:b0128df93d26 142 {
Davidroid 4:07acd6934359 143 STSpin240_250_Board_DisableBridge();
davide.aliprandi@st.com 3:b0128df93d26 144 device_prm.bridgeEnabled[BRIDGE_A] = FALSE;
davide.aliprandi@st.com 3:b0128df93d26 145 device_prm.bridgeEnabled[BRIDGE_B] = FALSE;
davide.aliprandi@st.com 3:b0128df93d26 146 }
davide.aliprandi@st.com 3:b0128df93d26 147
davide.aliprandi@st.com 3:b0128df93d26 148 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 149 * @brief Enable the specified bridge
davide.aliprandi@st.com 3:b0128df93d26 150 * @param[in] bridgeId (from 0 for bridge A to 1 for bridge B)
davide.aliprandi@st.com 3:b0128df93d26 151 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 152 * @note Bridge A and bridge B share the same enable pin.
davide.aliprandi@st.com 3:b0128df93d26 153 * When bridge A is enabled, bridge B is enabled and
davide.aliprandi@st.com 3:b0128df93d26 154 * reversely
davide.aliprandi@st.com 3:b0128df93d26 155 **********************************************************/
Davidroid 4:07acd6934359 156 void STSpin240_250::STSpin240_250_EnableBridge(uint8_t bridgeId)
davide.aliprandi@st.com 3:b0128df93d26 157 {
davide.aliprandi@st.com 3:b0128df93d26 158 device_prm.bridgeEnabled[BRIDGE_A] = TRUE;
davide.aliprandi@st.com 3:b0128df93d26 159 device_prm.bridgeEnabled[BRIDGE_B] = TRUE;
Davidroid 4:07acd6934359 160 STSpin240_250_Board_EnableBridge(1);
davide.aliprandi@st.com 3:b0128df93d26 161 }
davide.aliprandi@st.com 3:b0128df93d26 162
davide.aliprandi@st.com 3:b0128df93d26 163 /**********************************************************
davide.aliprandi@st.com 3:b0128df93d26 164 * @brief Error handler which calls the user callback (if defined)
davide.aliprandi@st.com 3:b0128df93d26 165 * @param[in] error Number of the error
davide.aliprandi@st.com 3:b0128df93d26 166 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 167 **********************************************************/
Davidroid 4:07acd6934359 168 void STSpin240_250::STSpin240_250_ErrorHandler(uint16_t error)
davide.aliprandi@st.com 3:b0128df93d26 169 {
davide.aliprandi@st.com 3:b0128df93d26 170 if (errorHandlerCallback != 0)
davide.aliprandi@st.com 3:b0128df93d26 171 {
davide.aliprandi@st.com 3:b0128df93d26 172 (void) errorHandlerCallback(error);
davide.aliprandi@st.com 3:b0128df93d26 173 }
davide.aliprandi@st.com 3:b0128df93d26 174 else
davide.aliprandi@st.com 3:b0128df93d26 175 {
davide.aliprandi@st.com 3:b0128df93d26 176 /* Aborting the program. */
davide.aliprandi@st.com 3:b0128df93d26 177 exit(EXIT_FAILURE);
davide.aliprandi@st.com 3:b0128df93d26 178 }
davide.aliprandi@st.com 3:b0128df93d26 179 }
davide.aliprandi@st.com 3:b0128df93d26 180
davide.aliprandi@st.com 3:b0128df93d26 181 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 182 * @brief Get the PWM frequency of the specified bridge
davide.aliprandi@st.com 3:b0128df93d26 183 * @param[in] bridgeId 0 for bridge A, 1 for bridge B
davide.aliprandi@st.com 3:b0128df93d26 184 * @retval Freq in Hz
davide.aliprandi@st.com 3:b0128df93d26 185 **********************************************************/
Davidroid 4:07acd6934359 186 uint32_t STSpin240_250::STSpin240_250_GetBridgeInputPwmFreq(uint8_t bridgeId)
davide.aliprandi@st.com 3:b0128df93d26 187 {
davide.aliprandi@st.com 3:b0128df93d26 188 if (bridgeId > BRIDGE_B)
davide.aliprandi@st.com 3:b0128df93d26 189 {
Davidroid 4:07acd6934359 190 STSpin240_250_ErrorHandler(STSPIN240_250_ERROR_2);
davide.aliprandi@st.com 3:b0128df93d26 191 }
davide.aliprandi@st.com 3:b0128df93d26 192
davide.aliprandi@st.com 3:b0128df93d26 193 return (device_prm.bridgePwmFreq[(bridgeId << 1)]);
davide.aliprandi@st.com 3:b0128df93d26 194 }
davide.aliprandi@st.com 3:b0128df93d26 195
davide.aliprandi@st.com 3:b0128df93d26 196 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 197 * @brief Get the status of the bridge enabling of the corresponding bridge
davide.aliprandi@st.com 3:b0128df93d26 198 * @param[in] bridgeId from 0 for bridge A to 1 for bridge B
davide.aliprandi@st.com 3:b0128df93d26 199 * @retval State of the Enable&Fault pin (shared for bridge A and B)
davide.aliprandi@st.com 3:b0128df93d26 200 **********************************************************/
Davidroid 4:07acd6934359 201 uint16_t STSpin240_250::STSpin240_250_GetBridgeStatus(void)
davide.aliprandi@st.com 3:b0128df93d26 202 {
Davidroid 4:07acd6934359 203 uint16_t status = STSpin240_250_Board_GetFaultPinState();
davide.aliprandi@st.com 3:b0128df93d26 204
davide.aliprandi@st.com 3:b0128df93d26 205 return (status);
davide.aliprandi@st.com 3:b0128df93d26 206 }
davide.aliprandi@st.com 3:b0128df93d26 207
davide.aliprandi@st.com 3:b0128df93d26 208 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 209 * @brief Returns the current speed of the specified motor
davide.aliprandi@st.com 3:b0128df93d26 210 * @param[in] motorId from 0 to (MAX_NUMBER_OF_BRUSH_DC_MOTORS - 1)
davide.aliprandi@st.com 3:b0128df93d26 211 * @retval current speed in % from 0 to 100
davide.aliprandi@st.com 3:b0128df93d26 212 **********************************************************/
Davidroid 4:07acd6934359 213 uint16_t STSpin240_250::STSpin240_250_GetCurrentSpeed(uint8_t motorId)
davide.aliprandi@st.com 3:b0128df93d26 214 {
davide.aliprandi@st.com 3:b0128df93d26 215 uint16_t speed = 0;
davide.aliprandi@st.com 3:b0128df93d26 216
davide.aliprandi@st.com 3:b0128df93d26 217 if (motorId >= arrayNbMaxMotorsByConfig[device_prm.dualBridgeEnabled])
davide.aliprandi@st.com 3:b0128df93d26 218 {
Davidroid 4:07acd6934359 219 STSpin240_250_ErrorHandler(STSPIN240_250_ERROR_1);
davide.aliprandi@st.com 3:b0128df93d26 220 }
davide.aliprandi@st.com 3:b0128df93d26 221 else if (device_prm.motionState[motorId] != INACTIVE)
davide.aliprandi@st.com 3:b0128df93d26 222 {
davide.aliprandi@st.com 3:b0128df93d26 223 speed = device_prm.speed[motorId];
davide.aliprandi@st.com 3:b0128df93d26 224 }
davide.aliprandi@st.com 3:b0128df93d26 225 return (speed);
davide.aliprandi@st.com 3:b0128df93d26 226 }
davide.aliprandi@st.com 3:b0128df93d26 227
davide.aliprandi@st.com 3:b0128df93d26 228 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 229 * @brief Returns the device state
davide.aliprandi@st.com 3:b0128df93d26 230 * @param[in] motorId from 0 to (MAX_NUMBER_OF_BRUSH_DC_MOTORS - 1)
davide.aliprandi@st.com 3:b0128df93d26 231 * @retval State (STEADY or INACTIVE)
davide.aliprandi@st.com 3:b0128df93d26 232 **********************************************************/
Davidroid 4:07acd6934359 233 motorState_t STSpin240_250::STSpin240_250_GetDeviceState(uint8_t motorId)
davide.aliprandi@st.com 3:b0128df93d26 234 {
davide.aliprandi@st.com 3:b0128df93d26 235 motorState_t state = INACTIVE;
davide.aliprandi@st.com 3:b0128df93d26 236
davide.aliprandi@st.com 3:b0128df93d26 237 if (motorId >= arrayNbMaxMotorsByConfig[device_prm.dualBridgeEnabled])
davide.aliprandi@st.com 3:b0128df93d26 238 {
Davidroid 4:07acd6934359 239 STSpin240_250_ErrorHandler(STSPIN240_250_ERROR_1);
davide.aliprandi@st.com 3:b0128df93d26 240 }
davide.aliprandi@st.com 3:b0128df93d26 241 else
davide.aliprandi@st.com 3:b0128df93d26 242 {
davide.aliprandi@st.com 3:b0128df93d26 243 state = device_prm.motionState[motorId];
davide.aliprandi@st.com 3:b0128df93d26 244 }
davide.aliprandi@st.com 3:b0128df93d26 245 return (state);
davide.aliprandi@st.com 3:b0128df93d26 246 }
davide.aliprandi@st.com 3:b0128df93d26 247
davide.aliprandi@st.com 3:b0128df93d26 248 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 249 * @brief Get the motor current direction
davide.aliprandi@st.com 3:b0128df93d26 250 * @param[in] motorId from 0 to (MAX_NUMBER_OF_BRUSH_DC_MOTORS - 1)
davide.aliprandi@st.com 3:b0128df93d26 251 * @retval direction
davide.aliprandi@st.com 3:b0128df93d26 252 **********************************************************/
Davidroid 4:07acd6934359 253 motorDir_t STSpin240_250::STSpin240_250_GetDirection(uint8_t motorId)
davide.aliprandi@st.com 3:b0128df93d26 254 {
davide.aliprandi@st.com 3:b0128df93d26 255 if (motorId >= arrayNbMaxMotorsByConfig[device_prm.dualBridgeEnabled])
davide.aliprandi@st.com 3:b0128df93d26 256 {
Davidroid 4:07acd6934359 257 STSpin240_250_ErrorHandler(STSPIN240_250_ERROR_1);
davide.aliprandi@st.com 3:b0128df93d26 258 }
davide.aliprandi@st.com 3:b0128df93d26 259
davide.aliprandi@st.com 3:b0128df93d26 260 return device_prm.direction[motorId];
davide.aliprandi@st.com 3:b0128df93d26 261 }
davide.aliprandi@st.com 3:b0128df93d26 262
davide.aliprandi@st.com 3:b0128df93d26 263 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 264 * @brief Returns the FW version of the library
davide.aliprandi@st.com 3:b0128df93d26 265 * @retval STSPIN240_250_FW_VERSION
davide.aliprandi@st.com 3:b0128df93d26 266 **********************************************************/
Davidroid 4:07acd6934359 267 uint32_t STSpin240_250::STSpin240_250_GetFwVersion(void)
davide.aliprandi@st.com 3:b0128df93d26 268 {
davide.aliprandi@st.com 3:b0128df93d26 269 return (STSPIN240_250_FW_VERSION);
davide.aliprandi@st.com 3:b0128df93d26 270 }
davide.aliprandi@st.com 3:b0128df93d26 271
davide.aliprandi@st.com 3:b0128df93d26 272
davide.aliprandi@st.com 3:b0128df93d26 273 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 274 * @brief Return the duty cycle of PWM used for REF
Davidroid 4:07acd6934359 275 * @param[in] refId 0 is the only supported id for STSpin240 or
Davidroid 4:07acd6934359 276 * STSpin250
davide.aliprandi@st.com 3:b0128df93d26 277 * @retval duty cycle in % (from 0 to 100)
davide.aliprandi@st.com 3:b0128df93d26 278 **********************************************************/
Davidroid 4:07acd6934359 279 uint8_t STSpin240_250::STSpin240_250_GetRefPwmDc(uint8_t refId)
davide.aliprandi@st.com 3:b0128df93d26 280 {
davide.aliprandi@st.com 3:b0128df93d26 281 uint32_t duty = 0;
davide.aliprandi@st.com 3:b0128df93d26 282
davide.aliprandi@st.com 3:b0128df93d26 283 if (duty == 0)
davide.aliprandi@st.com 3:b0128df93d26 284 {
davide.aliprandi@st.com 3:b0128df93d26 285 duty = device_prm.refPwmDc;
davide.aliprandi@st.com 3:b0128df93d26 286 }
davide.aliprandi@st.com 3:b0128df93d26 287 return (duty);
davide.aliprandi@st.com 3:b0128df93d26 288 }
davide.aliprandi@st.com 3:b0128df93d26 289
davide.aliprandi@st.com 3:b0128df93d26 290 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 291 * @brief Return the frequency of PWM used for REF
Davidroid 4:07acd6934359 292 * @param[in] refId 0 is the only supported id for STSpin240 or
Davidroid 4:07acd6934359 293 * STSpin250
davide.aliprandi@st.com 3:b0128df93d26 294 * @retval Frequency in Hz
davide.aliprandi@st.com 3:b0128df93d26 295 **********************************************************/
Davidroid 4:07acd6934359 296 uint32_t STSpin240_250::STSpin240_250_GetRefPwmFreq(uint8_t refId)
davide.aliprandi@st.com 3:b0128df93d26 297 {
davide.aliprandi@st.com 3:b0128df93d26 298 uint32_t freq = 0;
davide.aliprandi@st.com 3:b0128df93d26 299
davide.aliprandi@st.com 3:b0128df93d26 300 if (refId == 0)
davide.aliprandi@st.com 3:b0128df93d26 301 {
davide.aliprandi@st.com 3:b0128df93d26 302 freq = device_prm.refPwmFreq;
davide.aliprandi@st.com 3:b0128df93d26 303 }
davide.aliprandi@st.com 3:b0128df93d26 304 return (freq);
davide.aliprandi@st.com 3:b0128df93d26 305 }
davide.aliprandi@st.com 3:b0128df93d26 306
davide.aliprandi@st.com 3:b0128df93d26 307 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 308 * @brief Immediatly stops the motor and disable the power bridge
davide.aliprandi@st.com 3:b0128df93d26 309 * @param[in] motorId from 0 to (MAX_NUMBER_OF_BRUSH_DC_MOTORS - 1)
davide.aliprandi@st.com 3:b0128df93d26 310 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 311 * @note As all motors uses the same power bridge, the
davide.aliprandi@st.com 3:b0128df93d26 312 * power bridge will be disable only if all motors are
davide.aliprandi@st.com 3:b0128df93d26 313 * stopped
davide.aliprandi@st.com 3:b0128df93d26 314 **********************************************************/
Davidroid 4:07acd6934359 315 void STSpin240_250::STSpin240_250_HardHiz(uint8_t motorId)
davide.aliprandi@st.com 3:b0128df93d26 316 {
davide.aliprandi@st.com 3:b0128df93d26 317 if (motorId >= arrayNbMaxMotorsByConfig[device_prm.dualBridgeEnabled])
davide.aliprandi@st.com 3:b0128df93d26 318 {
Davidroid 4:07acd6934359 319 STSpin240_250_ErrorHandler(STSPIN240_250_ERROR_1);
davide.aliprandi@st.com 3:b0128df93d26 320 }
davide.aliprandi@st.com 3:b0128df93d26 321 else
davide.aliprandi@st.com 3:b0128df93d26 322 {
davide.aliprandi@st.com 3:b0128df93d26 323 if (device_prm.bridgeEnabled[motorId] != FALSE)
davide.aliprandi@st.com 3:b0128df93d26 324 {
davide.aliprandi@st.com 3:b0128df93d26 325 /* Only disable bridges if dual bridge mode is disabled or */
davide.aliprandi@st.com 3:b0128df93d26 326 /* if all motors are inactive as there are sharing the same power stage */
davide.aliprandi@st.com 3:b0128df93d26 327 if ((device_prm.dualBridgeEnabled == 0)||
davide.aliprandi@st.com 3:b0128df93d26 328 ((motorId == 0)&&(device_prm.motionState[1] == INACTIVE))||
davide.aliprandi@st.com 3:b0128df93d26 329 ((motorId == 1)&&(device_prm.motionState[0] == INACTIVE)))
davide.aliprandi@st.com 3:b0128df93d26 330 {
davide.aliprandi@st.com 3:b0128df93d26 331 /* Disable the bridge */
Davidroid 4:07acd6934359 332 STSpin240_250_DisableBridge(motorId);
davide.aliprandi@st.com 3:b0128df93d26 333 }
davide.aliprandi@st.com 3:b0128df93d26 334 }
davide.aliprandi@st.com 3:b0128df93d26 335 /* Disable the PWM */
Davidroid 4:07acd6934359 336 STSpin240_250_HardStop(motorId);
davide.aliprandi@st.com 3:b0128df93d26 337 }
davide.aliprandi@st.com 3:b0128df93d26 338 }
davide.aliprandi@st.com 3:b0128df93d26 339
davide.aliprandi@st.com 3:b0128df93d26 340 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 341 * @brief Stops the motor without disabling the bridge
davide.aliprandi@st.com 3:b0128df93d26 342 * @param[in] motorId from 0 to (MAX_NUMBER_OF_BRUSH_DC_MOTORS - 1)
davide.aliprandi@st.com 3:b0128df93d26 343 * @retval none
davide.aliprandi@st.com 3:b0128df93d26 344 **********************************************************/
Davidroid 4:07acd6934359 345 void STSpin240_250::STSpin240_250_HardStop(uint8_t motorId)
davide.aliprandi@st.com 3:b0128df93d26 346 {
davide.aliprandi@st.com 3:b0128df93d26 347 if (motorId >= arrayNbMaxMotorsByConfig[device_prm.dualBridgeEnabled])
davide.aliprandi@st.com 3:b0128df93d26 348 {
Davidroid 4:07acd6934359 349 STSpin240_250_ErrorHandler(STSPIN240_250_ERROR_1);
davide.aliprandi@st.com 3:b0128df93d26 350 }
davide.aliprandi@st.com 3:b0128df93d26 351 else if (device_prm.motionState[motorId] != INACTIVE)
davide.aliprandi@st.com 3:b0128df93d26 352 {
davide.aliprandi@st.com 3:b0128df93d26 353 /* Disable corresponding PWM */
Davidroid 4:07acd6934359 354 STSpin240_250_Board_PwmStop(motorId);
davide.aliprandi@st.com 3:b0128df93d26 355
davide.aliprandi@st.com 3:b0128df93d26 356 /* Set inactive state */
davide.aliprandi@st.com 3:b0128df93d26 357 device_prm.motionState[motorId] = INACTIVE;
davide.aliprandi@st.com 3:b0128df93d26 358 }
davide.aliprandi@st.com 3:b0128df93d26 359 }
davide.aliprandi@st.com 3:b0128df93d26 360
davide.aliprandi@st.com 3:b0128df93d26 361 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 362 * @brief Release reset (exit standby mode)
davide.aliprandi@st.com 3:b0128df93d26 363 * @param[in] deviceId (from 0 to MAX_NUMBER_OF_DEVICES -1)
davide.aliprandi@st.com 3:b0128df93d26 364 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 365 **********************************************************/
Davidroid 4:07acd6934359 366 void STSpin240_250::STSpin240_250_ReleaseReset(void)
davide.aliprandi@st.com 3:b0128df93d26 367 {
Davidroid 4:07acd6934359 368 STSpin240_250_Board_ReleaseReset();
davide.aliprandi@st.com 3:b0128df93d26 369
davide.aliprandi@st.com 3:b0128df93d26 370 /* Start PWM used for REF pin */
Davidroid 4:07acd6934359 371 STSpin240_250_Board_PwmSetFreq(PWM_REF, device_prm.refPwmFreq,device_prm.refPwmDc);
davide.aliprandi@st.com 3:b0128df93d26 372 }
davide.aliprandi@st.com 3:b0128df93d26 373
davide.aliprandi@st.com 3:b0128df93d26 374 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 375 * @brief Reset (enter standby mode)
davide.aliprandi@st.com 3:b0128df93d26 376 * @param[in] deviceId (from 0 to MAX_NUMBER_OF_DEVICES -1)
davide.aliprandi@st.com 3:b0128df93d26 377 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 378 **********************************************************/
Davidroid 4:07acd6934359 379 void STSpin240_250::STSpin240_250_Reset(void)
davide.aliprandi@st.com 3:b0128df93d26 380 {
davide.aliprandi@st.com 3:b0128df93d26 381 uint8_t loop;
davide.aliprandi@st.com 3:b0128df93d26 382 for (loop = 0; loop < STSPIN240_250_NB_MAX_MOTORS; loop++)
davide.aliprandi@st.com 3:b0128df93d26 383 {
davide.aliprandi@st.com 3:b0128df93d26 384 /* Stop motor if needed*/
davide.aliprandi@st.com 3:b0128df93d26 385 if (device_prm.motionState[loop] != INACTIVE)
davide.aliprandi@st.com 3:b0128df93d26 386 {
Davidroid 4:07acd6934359 387 STSpin240_250_HardStop(loop);
davide.aliprandi@st.com 3:b0128df93d26 388 }
davide.aliprandi@st.com 3:b0128df93d26 389 /* Disable bridge if needed */
davide.aliprandi@st.com 3:b0128df93d26 390 if (device_prm.bridgeEnabled[loop] != FALSE)
davide.aliprandi@st.com 3:b0128df93d26 391 {
Davidroid 4:07acd6934359 392 STSpin240_250_DisableBridge(loop);
davide.aliprandi@st.com 3:b0128df93d26 393 }
davide.aliprandi@st.com 3:b0128df93d26 394 }
davide.aliprandi@st.com 3:b0128df93d26 395
davide.aliprandi@st.com 3:b0128df93d26 396 /* Stop PWM used for REF pin */
Davidroid 4:07acd6934359 397 STSpin240_250_Board_PwmStop(PWM_REF);
davide.aliprandi@st.com 3:b0128df93d26 398
davide.aliprandi@st.com 3:b0128df93d26 399 /* Reset the STBY/RESET pin */
Davidroid 4:07acd6934359 400 STSpin240_250_Board_Reset();
davide.aliprandi@st.com 3:b0128df93d26 401 }
davide.aliprandi@st.com 3:b0128df93d26 402
davide.aliprandi@st.com 3:b0128df93d26 403 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 404 * @brief Runs the motor
davide.aliprandi@st.com 3:b0128df93d26 405 * @param[in] motorId from 0 to (MAX_NUMBER_OF_BRUSH_DC_MOTORS - 1)
davide.aliprandi@st.com 3:b0128df93d26 406 * @param[in] direction FORWARD or BACKWARD
davide.aliprandi@st.com 3:b0128df93d26 407 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 408 * @note For unidirectionnal motor, direction parameter has
davide.aliprandi@st.com 3:b0128df93d26 409 * no effect
davide.aliprandi@st.com 3:b0128df93d26 410 **********************************************************/
Davidroid 4:07acd6934359 411 void STSpin240_250::STSpin240_250_Run(uint8_t motorId, motorDir_t direction)
davide.aliprandi@st.com 3:b0128df93d26 412 {
davide.aliprandi@st.com 3:b0128df93d26 413 if (motorId >= arrayNbMaxMotorsByConfig[device_prm.dualBridgeEnabled])
davide.aliprandi@st.com 3:b0128df93d26 414 {
Davidroid 4:07acd6934359 415 STSpin240_250_ErrorHandler(STSPIN240_250_ERROR_1);
davide.aliprandi@st.com 3:b0128df93d26 416 }
davide.aliprandi@st.com 3:b0128df93d26 417 else if ((device_prm.motionState[motorId] == INACTIVE) ||
davide.aliprandi@st.com 3:b0128df93d26 418 (device_prm.direction[motorId] != direction))
davide.aliprandi@st.com 3:b0128df93d26 419 {
davide.aliprandi@st.com 3:b0128df93d26 420
davide.aliprandi@st.com 3:b0128df93d26 421 /* Release reset if required */
Davidroid 4:07acd6934359 422 if (STSpin240_250_GetResetState() == 0)
davide.aliprandi@st.com 3:b0128df93d26 423 {
Davidroid 4:07acd6934359 424 STSpin240_250_ReleaseReset();
davide.aliprandi@st.com 3:b0128df93d26 425 }
davide.aliprandi@st.com 3:b0128df93d26 426
davide.aliprandi@st.com 3:b0128df93d26 427 /* Eventually deactivate motor */
davide.aliprandi@st.com 3:b0128df93d26 428 if (device_prm.motionState[motorId] != INACTIVE)
davide.aliprandi@st.com 3:b0128df93d26 429 {
Davidroid 4:07acd6934359 430 STSpin240_250_HardStop(motorId);
davide.aliprandi@st.com 3:b0128df93d26 431 }
davide.aliprandi@st.com 3:b0128df93d26 432
davide.aliprandi@st.com 3:b0128df93d26 433 /* Set direction */
Davidroid 4:07acd6934359 434 STSpin240_250_SetDirection(motorId, direction);
davide.aliprandi@st.com 3:b0128df93d26 435
davide.aliprandi@st.com 3:b0128df93d26 436 /* Switch to steady state */
davide.aliprandi@st.com 3:b0128df93d26 437 device_prm.motionState[motorId] = STEADY;
davide.aliprandi@st.com 3:b0128df93d26 438
davide.aliprandi@st.com 3:b0128df93d26 439 /* Enable bridge */
davide.aliprandi@st.com 3:b0128df93d26 440 if (device_prm.bridgeEnabled[motorId] == FALSE)
davide.aliprandi@st.com 3:b0128df93d26 441 {
Davidroid 4:07acd6934359 442 STSpin240_250_EnableBridge(motorId);
davide.aliprandi@st.com 3:b0128df93d26 443 }
davide.aliprandi@st.com 3:b0128df93d26 444 /* Set PWM */
Davidroid 4:07acd6934359 445 STSpin240_250_Board_PwmSetFreq(motorId, device_prm.bridgePwmFreq[motorId],device_prm.speed[motorId]);
davide.aliprandi@st.com 3:b0128df93d26 446 }
davide.aliprandi@st.com 3:b0128df93d26 447 }
davide.aliprandi@st.com 3:b0128df93d26 448
davide.aliprandi@st.com 3:b0128df93d26 449 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 450 * @brief Changes the PWM frequency of the bridge input
davide.aliprandi@st.com 3:b0128df93d26 451 * @param[in] bridgeId 0 for bridge A, 1 for bridge B
davide.aliprandi@st.com 3:b0128df93d26 452 * @param[in] newFreq in Hz
davide.aliprandi@st.com 3:b0128df93d26 453 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 454 * @note 1)The PWM is only enabled when the motor is requested
davide.aliprandi@st.com 3:b0128df93d26 455 * to run.
davide.aliprandi@st.com 3:b0128df93d26 456 * 2) If the two bridges share the same timer, their frequency
davide.aliprandi@st.com 3:b0128df93d26 457 * has to be the same
davide.aliprandi@st.com 3:b0128df93d26 458 * 3) If the two bridges share the same timer, the frequency
davide.aliprandi@st.com 3:b0128df93d26 459 * is updated on the fly is there is only one motor running
davide.aliprandi@st.com 3:b0128df93d26 460 * on the targeted bridge.
davide.aliprandi@st.com 3:b0128df93d26 461 **********************************************************/
Davidroid 4:07acd6934359 462 void STSpin240_250::STSpin240_250_SetBridgeInputPwmFreq(uint8_t bridgeId, uint32_t newFreq)
davide.aliprandi@st.com 3:b0128df93d26 463 {
davide.aliprandi@st.com 3:b0128df93d26 464 if (bridgeId > BRIDGE_B)
davide.aliprandi@st.com 3:b0128df93d26 465 {
Davidroid 4:07acd6934359 466 STSpin240_250_ErrorHandler(STSPIN240_250_ERROR_2);
davide.aliprandi@st.com 3:b0128df93d26 467 }
davide.aliprandi@st.com 3:b0128df93d26 468
davide.aliprandi@st.com 3:b0128df93d26 469 if (newFreq > STSPIN240_250_MAX_PWM_FREQ)
davide.aliprandi@st.com 3:b0128df93d26 470 {
davide.aliprandi@st.com 3:b0128df93d26 471 newFreq = STSPIN240_250_MAX_PWM_FREQ;
davide.aliprandi@st.com 3:b0128df93d26 472 }
davide.aliprandi@st.com 3:b0128df93d26 473
davide.aliprandi@st.com 3:b0128df93d26 474 device_prm.bridgePwmFreq[bridgeId] = newFreq;
davide.aliprandi@st.com 3:b0128df93d26 475
davide.aliprandi@st.com 3:b0128df93d26 476 if (device_prm.motionState[bridgeId] != INACTIVE)
davide.aliprandi@st.com 3:b0128df93d26 477 {
Davidroid 4:07acd6934359 478 STSpin240_250_Board_PwmSetFreq(bridgeId, device_prm.bridgePwmFreq[bridgeId],device_prm.speed[bridgeId]);
davide.aliprandi@st.com 3:b0128df93d26 479 }
davide.aliprandi@st.com 3:b0128df93d26 480 }
davide.aliprandi@st.com 3:b0128df93d26 481
davide.aliprandi@st.com 3:b0128df93d26 482 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 483 * @brief Specifies the direction
davide.aliprandi@st.com 3:b0128df93d26 484 * @param[in] motorId from 0 to (MAX_NUMBER_OF_BRUSH_DC_MOTORS - 1)
davide.aliprandi@st.com 3:b0128df93d26 485 * @param[in] dir FORWARD or BACKWARD
davide.aliprandi@st.com 3:b0128df93d26 486 * @note The direction change is only applied if the device
davide.aliprandi@st.com 3:b0128df93d26 487 * is in INACTIVE state. To change direction while motor is
davide.aliprandi@st.com 3:b0128df93d26 488 * running, use the run function
davide.aliprandi@st.com 3:b0128df93d26 489 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 490 **********************************************************/
Davidroid 4:07acd6934359 491 void STSpin240_250::STSpin240_250_SetDirection(uint8_t motorId, motorDir_t dir)
davide.aliprandi@st.com 3:b0128df93d26 492 {
davide.aliprandi@st.com 3:b0128df93d26 493 if (motorId >= arrayNbMaxMotorsByConfig[device_prm.dualBridgeEnabled])
davide.aliprandi@st.com 3:b0128df93d26 494 {
Davidroid 4:07acd6934359 495 STSpin240_250_ErrorHandler(STSPIN240_250_ERROR_1);
davide.aliprandi@st.com 3:b0128df93d26 496 }
davide.aliprandi@st.com 3:b0128df93d26 497 else if (device_prm.motionState[motorId] == INACTIVE)
davide.aliprandi@st.com 3:b0128df93d26 498 {
Davidroid 4:07acd6934359 499 STSpin240_250_Board_SetDirectionGpio(motorId, dir);
davide.aliprandi@st.com 3:b0128df93d26 500 device_prm.direction[motorId] = dir;
davide.aliprandi@st.com 3:b0128df93d26 501 }
davide.aliprandi@st.com 3:b0128df93d26 502 }
davide.aliprandi@st.com 3:b0128df93d26 503
davide.aliprandi@st.com 3:b0128df93d26 504 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 505 * @brief Set the dual bridge configuration mode
davide.aliprandi@st.com 3:b0128df93d26 506 * @param[in] enable 0 to disable,
davide.aliprandi@st.com 3:b0128df93d26 507 * 1 to enable (not supported by STSPIN250)
davide.aliprandi@st.com 3:b0128df93d26 508 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 509 **********************************************************/
Davidroid 4:07acd6934359 510 void STSpin240_250::STSpin240_250_SetDualFullBridgeconfig(uint8_t enable)
davide.aliprandi@st.com 3:b0128df93d26 511 {
davide.aliprandi@st.com 3:b0128df93d26 512 device_prm.dualBridgeEnabled = enable;
davide.aliprandi@st.com 3:b0128df93d26 513
davide.aliprandi@st.com 3:b0128df93d26 514 /* Check reset pin state*/
Davidroid 4:07acd6934359 515 if (STSpin240_250_GetResetState() != 0)
davide.aliprandi@st.com 3:b0128df93d26 516 {
Davidroid 4:07acd6934359 517 STSpin240_250_Reset();
Davidroid 4:07acd6934359 518 STSpin240_250_ReleaseReset();
davide.aliprandi@st.com 3:b0128df93d26 519 }
davide.aliprandi@st.com 3:b0128df93d26 520 }
davide.aliprandi@st.com 3:b0128df93d26 521
davide.aliprandi@st.com 3:b0128df93d26 522 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 523 * @brief Changes the max speed of the specified device
davide.aliprandi@st.com 3:b0128df93d26 524 * @param[in] motorId from 0 to (MAX_NUMBER_OF_BRUSH_DC_MOTORS - 1)
davide.aliprandi@st.com 3:b0128df93d26 525 * @param[in] newMaxSpeed in % from 0 to 100
davide.aliprandi@st.com 3:b0128df93d26 526 * @retval true if the command is successfully executed, else false
davide.aliprandi@st.com 3:b0128df93d26 527 **********************************************************/
Davidroid 4:07acd6934359 528 bool STSpin240_250::STSpin240_250_SetMaxSpeed(uint8_t motorId, uint16_t newMaxSpeed)
davide.aliprandi@st.com 3:b0128df93d26 529 {
davide.aliprandi@st.com 3:b0128df93d26 530 bool cmdExecuted = FALSE;
davide.aliprandi@st.com 3:b0128df93d26 531
davide.aliprandi@st.com 3:b0128df93d26 532 if (motorId >= arrayNbMaxMotorsByConfig[device_prm.dualBridgeEnabled])
davide.aliprandi@st.com 3:b0128df93d26 533 {
Davidroid 4:07acd6934359 534 STSpin240_250_ErrorHandler(STSPIN240_250_ERROR_1);
davide.aliprandi@st.com 3:b0128df93d26 535 }
davide.aliprandi@st.com 3:b0128df93d26 536 else
davide.aliprandi@st.com 3:b0128df93d26 537 {
davide.aliprandi@st.com 3:b0128df93d26 538 device_prm.speed[motorId] = newMaxSpeed;
davide.aliprandi@st.com 3:b0128df93d26 539 if (device_prm.motionState[motorId] != INACTIVE)
davide.aliprandi@st.com 3:b0128df93d26 540 {
davide.aliprandi@st.com 3:b0128df93d26 541 /* Set PWM frequency*/
Davidroid 4:07acd6934359 542 STSpin240_250_Board_PwmSetFreq(motorId, device_prm.bridgePwmFreq[motorId],device_prm.speed[motorId]);
davide.aliprandi@st.com 3:b0128df93d26 543 }
davide.aliprandi@st.com 3:b0128df93d26 544 cmdExecuted = TRUE;
davide.aliprandi@st.com 3:b0128df93d26 545 }
davide.aliprandi@st.com 3:b0128df93d26 546 return cmdExecuted;
davide.aliprandi@st.com 3:b0128df93d26 547 }
davide.aliprandi@st.com 3:b0128df93d26 548
davide.aliprandi@st.com 3:b0128df93d26 549 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 550 * @brief Changes the duty cycle of the PWM used for REF
Davidroid 4:07acd6934359 551 * @param[in] refId 0 is the only supported id for STSpin240 or
Davidroid 4:07acd6934359 552 * STSpin250
davide.aliprandi@st.com 3:b0128df93d26 553 * @param[in] newDc new duty cycle from 0 to 100
davide.aliprandi@st.com 3:b0128df93d26 554 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 555 **********************************************************/
Davidroid 4:07acd6934359 556 void STSpin240_250::STSpin240_250_SetRefPwmDc(uint8_t refId, uint8_t newDc)
davide.aliprandi@st.com 3:b0128df93d26 557 {
davide.aliprandi@st.com 3:b0128df93d26 558 if (newDc > 100)
davide.aliprandi@st.com 3:b0128df93d26 559 {
davide.aliprandi@st.com 3:b0128df93d26 560 newDc = 100;
davide.aliprandi@st.com 3:b0128df93d26 561 }
davide.aliprandi@st.com 3:b0128df93d26 562
davide.aliprandi@st.com 3:b0128df93d26 563 device_prm.refPwmDc = newDc;
davide.aliprandi@st.com 3:b0128df93d26 564
Davidroid 4:07acd6934359 565 if (STSpin240_250_GetResetState() != 0)
davide.aliprandi@st.com 3:b0128df93d26 566 {
davide.aliprandi@st.com 3:b0128df93d26 567 /* Immediatly set the PWM frequency for ref if chip is not in reset */
Davidroid 4:07acd6934359 568 STSpin240_250_Board_PwmSetFreq(PWM_REF, device_prm.refPwmFreq,device_prm.refPwmDc);
davide.aliprandi@st.com 3:b0128df93d26 569 }
davide.aliprandi@st.com 3:b0128df93d26 570 }
davide.aliprandi@st.com 3:b0128df93d26 571
davide.aliprandi@st.com 3:b0128df93d26 572 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 573 * @brief Changes the frequency of PWM used for REF
Davidroid 4:07acd6934359 574 * @param[in] refId 0 is the only supported id for STSpin240 or
Davidroid 4:07acd6934359 575 * STSpin250
davide.aliprandi@st.com 3:b0128df93d26 576 * @param[in] newFreq in Hz
davide.aliprandi@st.com 3:b0128df93d26 577 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 578 **********************************************************/
Davidroid 4:07acd6934359 579 void STSpin240_250::STSpin240_250_SetRefPwmFreq(uint8_t refId, uint32_t newFreq)
davide.aliprandi@st.com 3:b0128df93d26 580 {
davide.aliprandi@st.com 3:b0128df93d26 581 if (newFreq > STSPIN240_250_MAX_PWM_FREQ)
davide.aliprandi@st.com 3:b0128df93d26 582 {
davide.aliprandi@st.com 3:b0128df93d26 583 newFreq = STSPIN240_250_MAX_PWM_FREQ;
davide.aliprandi@st.com 3:b0128df93d26 584 }
davide.aliprandi@st.com 3:b0128df93d26 585
davide.aliprandi@st.com 3:b0128df93d26 586 device_prm.refPwmFreq = newFreq;
davide.aliprandi@st.com 3:b0128df93d26 587
Davidroid 4:07acd6934359 588 if (STSpin240_250_GetResetState() != 0)
davide.aliprandi@st.com 3:b0128df93d26 589 {
davide.aliprandi@st.com 3:b0128df93d26 590 /* Immediatly set the PWM frequency for ref if chip is not in reset */
Davidroid 4:07acd6934359 591 STSpin240_250_Board_PwmSetFreq(PWM_REF, device_prm.refPwmFreq,device_prm.refPwmDc);
davide.aliprandi@st.com 3:b0128df93d26 592 }
davide.aliprandi@st.com 3:b0128df93d26 593 }
davide.aliprandi@st.com 3:b0128df93d26 594
davide.aliprandi@st.com 3:b0128df93d26 595
davide.aliprandi@st.com 3:b0128df93d26 596 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 597 * @brief Get the status of the bridge enabling of the corresponding bridge
davide.aliprandi@st.com 3:b0128df93d26 598 * @retval State of the Enable&Fault pin (shared for bridge A and B)
davide.aliprandi@st.com 3:b0128df93d26 599 **********************************************************/
Davidroid 4:07acd6934359 600 uint8_t STSpin240_250::STSpin240_250_GetResetState(void)
davide.aliprandi@st.com 3:b0128df93d26 601 {
Davidroid 4:07acd6934359 602 uint8_t status = STSpin240_250_Board_GetResetPinState();
davide.aliprandi@st.com 3:b0128df93d26 603
davide.aliprandi@st.com 3:b0128df93d26 604 return (status);
davide.aliprandi@st.com 3:b0128df93d26 605 }
davide.aliprandi@st.com 3:b0128df93d26 606
davide.aliprandi@st.com 3:b0128df93d26 607 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 608 * @brief Set the parameters of the device to values of pInitPrm structure
davide.aliprandi@st.com 3:b0128df93d26 609 * @param[in] deviceId (from 0 to MAX_NUMBER_OF_DEVICES -1)
davide.aliprandi@st.com 3:b0128df93d26 610 * @param pInitPrm pointer to a structure containing the initial device parameters
davide.aliprandi@st.com 3:b0128df93d26 611 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 612 **********************************************************/
Davidroid 4:07acd6934359 613 void STSpin240_250::STSpin240_250_SetDeviceParamsToGivenValues(STSpin240_250_init_t *pInitPrm)
davide.aliprandi@st.com 3:b0128df93d26 614 {
davide.aliprandi@st.com 3:b0128df93d26 615 uint32_t i;
davide.aliprandi@st.com 3:b0128df93d26 616
davide.aliprandi@st.com 3:b0128df93d26 617 device_prm.dualBridgeEnabled = pInitPrm->dualBridgeEnabled;
davide.aliprandi@st.com 3:b0128df93d26 618
davide.aliprandi@st.com 3:b0128df93d26 619 device_prm.bridgePwmFreq[BRIDGE_A] = pInitPrm->bridgePwmFreq[BRIDGE_A];
davide.aliprandi@st.com 3:b0128df93d26 620 device_prm.bridgePwmFreq[BRIDGE_B] = pInitPrm->bridgePwmFreq[BRIDGE_B];;
davide.aliprandi@st.com 3:b0128df93d26 621
davide.aliprandi@st.com 3:b0128df93d26 622 device_prm.refPwmFreq = pInitPrm->refPwmFreq;
davide.aliprandi@st.com 3:b0128df93d26 623 device_prm.refPwmDc = pInitPrm->refPwmDc;
davide.aliprandi@st.com 3:b0128df93d26 624
davide.aliprandi@st.com 3:b0128df93d26 625 for (i = 0; i < MAX_NUMBER_OF_BRUSH_DC_MOTORS; i++)
davide.aliprandi@st.com 3:b0128df93d26 626 {
davide.aliprandi@st.com 3:b0128df93d26 627 device_prm.speed[i] = 100;
davide.aliprandi@st.com 3:b0128df93d26 628 device_prm.direction[i] = FORWARD;
davide.aliprandi@st.com 3:b0128df93d26 629 device_prm.motionState[i] = INACTIVE;
davide.aliprandi@st.com 3:b0128df93d26 630 }
davide.aliprandi@st.com 3:b0128df93d26 631 for (i = 0; i < STSPIN240_250_NB_BRIDGES; i++)
davide.aliprandi@st.com 3:b0128df93d26 632 {
davide.aliprandi@st.com 3:b0128df93d26 633 device_prm.bridgeEnabled[i] = FALSE;
davide.aliprandi@st.com 3:b0128df93d26 634 }
davide.aliprandi@st.com 3:b0128df93d26 635 }
davide.aliprandi@st.com 3:b0128df93d26 636 /******************************************************//**
davide.aliprandi@st.com 3:b0128df93d26 637 * @brief Sets the parameters of the device to predefined values
Davidroid 4:07acd6934359 638 * from STSpin240_250_target_config.h
davide.aliprandi@st.com 3:b0128df93d26 639 * @retval None
davide.aliprandi@st.com 3:b0128df93d26 640 **********************************************************/
Davidroid 4:07acd6934359 641 void STSpin240_250::STSpin240_250_SetDeviceParamsToPredefinedValues(void)
davide.aliprandi@st.com 3:b0128df93d26 642 {
davide.aliprandi@st.com 3:b0128df93d26 643 uint32_t i;
davide.aliprandi@st.com 3:b0128df93d26 644
davide.aliprandi@st.com 3:b0128df93d26 645 device_prm.dualBridgeEnabled = STSPIN240_250_CONF_PARAM_DUAL_BRIDGE_ENABLING;
davide.aliprandi@st.com 3:b0128df93d26 646
davide.aliprandi@st.com 3:b0128df93d26 647 device_prm.bridgePwmFreq[BRIDGE_A] = STSPIN240_250_CONF_PARAM_FREQ_PWM_A;
davide.aliprandi@st.com 3:b0128df93d26 648 device_prm.bridgePwmFreq[BRIDGE_B] = STSPIN240_250_CONF_PARAM_FREQ_PWM_B;
davide.aliprandi@st.com 3:b0128df93d26 649
davide.aliprandi@st.com 3:b0128df93d26 650 device_prm.refPwmFreq = STSPIN240_250_CONF_PARAM_FREQ_PWM_REF;
davide.aliprandi@st.com 3:b0128df93d26 651 device_prm.refPwmDc = STSPIN240_250_CONF_PARAM_DC_PWM_REF;
davide.aliprandi@st.com 3:b0128df93d26 652
davide.aliprandi@st.com 3:b0128df93d26 653 for (i = 0; i < MAX_NUMBER_OF_BRUSH_DC_MOTORS; i++)
davide.aliprandi@st.com 3:b0128df93d26 654 {
davide.aliprandi@st.com 3:b0128df93d26 655 device_prm.speed[i] = 100;
davide.aliprandi@st.com 3:b0128df93d26 656 device_prm.direction[i] = FORWARD;
davide.aliprandi@st.com 3:b0128df93d26 657 device_prm.motionState[i] = INACTIVE;
davide.aliprandi@st.com 3:b0128df93d26 658 }
davide.aliprandi@st.com 3:b0128df93d26 659 for (i = 0; i < STSPIN240_250_NB_BRIDGES; i++)
davide.aliprandi@st.com 3:b0128df93d26 660 {
davide.aliprandi@st.com 3:b0128df93d26 661 device_prm.bridgeEnabled[i] = FALSE;
davide.aliprandi@st.com 3:b0128df93d26 662 }
davide.aliprandi@st.com 3:b0128df93d26 663 }
davide.aliprandi@st.com 3:b0128df93d26 664 /************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/