Personal fork of the library for direct control instead of library control

Dependencies:   X_NUCLEO_COMMON

Dependents:   Thesis_Rotating_Platform

Fork of X_NUCLEO_IHM01A1 by Arkadi Rafalovich

Committer:
Davidroid
Date:
Mon Dec 14 17:25:36 2015 +0000
Revision:
16:bec7dd79f328
Parent:
15:40470df81d9a
Child:
17:35b9ca8c4bd6
+ Default initialization structure set to NULL.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Davidroid 0:2887415a46cd 1 /**
Davidroid 10:c3824af0caf4 2 ******************************************************************************
Davidroid 10:c3824af0caf4 3 * @file l6474_class.h
Davidroid 10:c3824af0caf4 4 * @author Davide Aliprandi, STMicrolectronics
Davidroid 10:c3824af0caf4 5 * @version V1.0.0
Davidroid 10:c3824af0caf4 6 * @date October 14th, 2015
Davidroid 10:c3824af0caf4 7 * @brief This file contains the class of an L6474 Motor Control component.
Davidroid 10:c3824af0caf4 8 ******************************************************************************
Davidroid 10:c3824af0caf4 9 * @attention
Davidroid 10:c3824af0caf4 10 *
Davidroid 10:c3824af0caf4 11 * <h2><center>&copy; COPYRIGHT(c) 2014 STMicroelectronics</center></h2>
Davidroid 10:c3824af0caf4 12 *
Davidroid 10:c3824af0caf4 13 * Redistribution and use in source and binary forms, with or without modification,
Davidroid 10:c3824af0caf4 14 * are permitted provided that the following conditions are met:
Davidroid 10:c3824af0caf4 15 * 1. Redistributions of source code must retain the above copyright notice,
Davidroid 10:c3824af0caf4 16 * this list of conditions and the following disclaimer.
Davidroid 10:c3824af0caf4 17 * 2. Redistributions in binary form must reproduce the above copyright notice,
Davidroid 10:c3824af0caf4 18 * this list of conditions and the following disclaimer in the documentation
Davidroid 10:c3824af0caf4 19 * and/or other materials provided with the distribution.
Davidroid 10:c3824af0caf4 20 * 3. Neither the name of STMicroelectronics nor the names of its contributors
Davidroid 10:c3824af0caf4 21 * may be used to endorse or promote products derived from this software
Davidroid 10:c3824af0caf4 22 * without specific prior written permission.
Davidroid 10:c3824af0caf4 23 *
Davidroid 10:c3824af0caf4 24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
Davidroid 10:c3824af0caf4 25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
Davidroid 10:c3824af0caf4 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
Davidroid 10:c3824af0caf4 27 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
Davidroid 10:c3824af0caf4 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
Davidroid 10:c3824af0caf4 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
Davidroid 10:c3824af0caf4 30 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
Davidroid 10:c3824af0caf4 31 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
Davidroid 10:c3824af0caf4 32 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
Davidroid 10:c3824af0caf4 33 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
Davidroid 10:c3824af0caf4 34 *
Davidroid 10:c3824af0caf4 35 ******************************************************************************
Davidroid 10:c3824af0caf4 36 */
Davidroid 0:2887415a46cd 37
Davidroid 0:2887415a46cd 38
Davidroid 0:2887415a46cd 39 /* Generated with Stm32CubeTOO -----------------------------------------------*/
Davidroid 0:2887415a46cd 40
Davidroid 0:2887415a46cd 41
Davidroid 0:2887415a46cd 42 /* Revision ------------------------------------------------------------------*/
Davidroid 0:2887415a46cd 43 /*
Davidroid 0:2887415a46cd 44 Repository: http://svn.x-nucleodev.codex.cro.st.com/svnroot/X-NucleoDev
Davidroid 0:2887415a46cd 45 Branch/Trunk/Tag: trunk
Davidroid 0:2887415a46cd 46 Based on: X-CUBE-SPN1/trunk/Drivers/BSP/Components/l6474/l6474.h
Davidroid 0:2887415a46cd 47 Revision: 0
Davidroid 0:2887415a46cd 48 */
Davidroid 0:2887415a46cd 49
Davidroid 0:2887415a46cd 50
Davidroid 0:2887415a46cd 51 /* Define to prevent recursive inclusion -------------------------------------*/
Davidroid 0:2887415a46cd 52
Davidroid 0:2887415a46cd 53 #ifndef __L6474_CLASS_H
Davidroid 0:2887415a46cd 54 #define __L6474_CLASS_H
Davidroid 0:2887415a46cd 55
Davidroid 0:2887415a46cd 56
Davidroid 0:2887415a46cd 57 /* Includes ------------------------------------------------------------------*/
Davidroid 0:2887415a46cd 58
Davidroid 0:2887415a46cd 59 /* ACTION 1 ------------------------------------------------------------------*
Davidroid 0:2887415a46cd 60 * Include here platform specific header files. *
Davidroid 0:2887415a46cd 61 *----------------------------------------------------------------------------*/
Davidroid 0:2887415a46cd 62 #include "mbed.h"
Davidroid 0:2887415a46cd 63 #include "DevSPI.h"
Davidroid 0:2887415a46cd 64 /* ACTION 2 ------------------------------------------------------------------*
Davidroid 0:2887415a46cd 65 * Include here component specific header files. *
Davidroid 0:2887415a46cd 66 *----------------------------------------------------------------------------*/
Davidroid 0:2887415a46cd 67 #include "l6474.h"
Davidroid 0:2887415a46cd 68 /* ACTION 3 ------------------------------------------------------------------*
Davidroid 0:2887415a46cd 69 * Include here interface specific header files. *
Davidroid 0:2887415a46cd 70 * *
Davidroid 0:2887415a46cd 71 * Example: *
Davidroid 0:2887415a46cd 72 * #include "../Interfaces/Humidity_class.h" *
Davidroid 0:2887415a46cd 73 * #include "../Interfaces/Temperature_class.h" *
Davidroid 0:2887415a46cd 74 *----------------------------------------------------------------------------*/
Davidroid 4:83a1eb397a65 75 #include "../Interfaces/StepperMotor_class.h"
Davidroid 0:2887415a46cd 76
Davidroid 0:2887415a46cd 77
Davidroid 0:2887415a46cd 78 /* Classes -------------------------------------------------------------------*/
Davidroid 0:2887415a46cd 79
Davidroid 10:c3824af0caf4 80 /**
Davidroid 10:c3824af0caf4 81 * @brief Class representing an L6474 component.
Davidroid 0:2887415a46cd 82 */
Davidroid 4:83a1eb397a65 83 class L6474 : public StepperMotor
Davidroid 0:2887415a46cd 84 {
Davidroid 0:2887415a46cd 85 public:
Davidroid 0:2887415a46cd 86
Davidroid 0:2887415a46cd 87 /*** Constructor and Destructor Methods ***/
Davidroid 0:2887415a46cd 88
Davidroid 0:2887415a46cd 89 /**
Davidroid 0:2887415a46cd 90 * @brief Constructor.
Davidroid 7:f7e0c3621f77 91 * @param flag_irq pin name of the FLAG pin of the component.
Davidroid 4:83a1eb397a65 92 * @param standby_reset pin name of the STBY\RST pin of the component.
Davidroid 4:83a1eb397a65 93 * @param direction pin name of the DIR pin of the component.
Davidroid 4:83a1eb397a65 94 * @param pwm pin name of the PWM pin of the component.
Davidroid 4:83a1eb397a65 95 * @param ssel pin name of the SSEL pin of the SPI device to be used for communication.
Davidroid 4:83a1eb397a65 96 * @param spi SPI device to be used for communication.
Davidroid 0:2887415a46cd 97 */
Davidroid 7:f7e0c3621f77 98 L6474(PinName flag_irq, PinName standby_reset, PinName direction, PinName pwm, PinName ssel, DevSPI &spi) : StepperMotor(), flag_irq(flag_irq), standby_reset(standby_reset), direction(direction), pwm(pwm), ssel(ssel), dev_spi(spi)
Davidroid 0:2887415a46cd 99 {
Davidroid 0:2887415a46cd 100 /* ACTION 4 ----------------------------------------------------------*
Davidroid 0:2887415a46cd 101 * Initialize here the component's member variables, one variable per *
Davidroid 0:2887415a46cd 102 * line. *
Davidroid 0:2887415a46cd 103 * *
Davidroid 0:2887415a46cd 104 * Example: *
Davidroid 15:40470df81d9a 105 * measure = 0; *
Davidroid 15:40470df81d9a 106 * instance_id = number_of_instances++; *
Davidroid 0:2887415a46cd 107 *--------------------------------------------------------------------*/
Davidroid 0:2887415a46cd 108 errorHandlerCallback = 0;
Davidroid 0:2887415a46cd 109 deviceInstance = numberOfDevices;
Davidroid 0:2887415a46cd 110 numberOfDevices++;
Davidroid 5:d3c78f12a78d 111 memset(spiTxBursts, 0, L6474_CMD_ARG_MAX_NB_BYTES * MAX_NUMBER_OF_DEVICES * sizeof(uint8_t));
Davidroid 5:d3c78f12a78d 112 memset(spiRxBursts, 0, L6474_CMD_ARG_MAX_NB_BYTES * MAX_NUMBER_OF_DEVICES * sizeof(uint8_t));
Davidroid 0:2887415a46cd 113 }
Davidroid 0:2887415a46cd 114
Davidroid 0:2887415a46cd 115 /**
Davidroid 0:2887415a46cd 116 * @brief Destructor.
Davidroid 0:2887415a46cd 117 */
Davidroid 0:2887415a46cd 118 virtual ~L6474(void) {}
Davidroid 0:2887415a46cd 119
Davidroid 0:2887415a46cd 120
Davidroid 0:2887415a46cd 121 /*** Public Component Related Methods ***/
Davidroid 0:2887415a46cd 122
Davidroid 0:2887415a46cd 123 /* ACTION 5 --------------------------------------------------------------*
Davidroid 0:2887415a46cd 124 * Implement here the component's public methods, as wrappers of the C *
Davidroid 0:2887415a46cd 125 * component's functions. *
Davidroid 0:2887415a46cd 126 * They should be: *
Davidroid 0:2887415a46cd 127 * + Methods with the same name of the C component's virtual table's *
Davidroid 0:2887415a46cd 128 * functions (1); *
Davidroid 0:2887415a46cd 129 * + Methods with the same name of the C component's extended virtual *
Davidroid 0:2887415a46cd 130 * table's functions, if any (2). *
Davidroid 0:2887415a46cd 131 * *
Davidroid 0:2887415a46cd 132 * Example: *
Davidroid 0:2887415a46cd 133 * virtual int GetValue(float *pData) //(1) *
Davidroid 0:2887415a46cd 134 * { *
Davidroid 0:2887415a46cd 135 * return COMPONENT_GetValue(float *pfData); *
Davidroid 0:2887415a46cd 136 * } *
Davidroid 0:2887415a46cd 137 * *
Davidroid 0:2887415a46cd 138 * virtual int EnableFeature(void) //(2) *
Davidroid 0:2887415a46cd 139 * { *
Davidroid 0:2887415a46cd 140 * return COMPONENT_EnableFeature(); *
Davidroid 0:2887415a46cd 141 * } *
Davidroid 0:2887415a46cd 142 *------------------------------------------------------------------------*/
Davidroid 7:f7e0c3621f77 143 /**
Davidroid 12:9f4b9540ff3e 144 * @brief Initializing the component in 1/16 Microstepping mode.
Davidroid 8:42e0b00b1e4d 145 * @param init Pointer to device specific initalization structure.
Davidroid 7:f7e0c3621f77 146 * @retval "0" in case of success, an error code otherwise.
Davidroid 7:f7e0c3621f77 147 */
Davidroid 16:bec7dd79f328 148 virtual int Init(void *init = NULL)
Davidroid 0:2887415a46cd 149 {
Davidroid 12:9f4b9540ff3e 150 return (int) L6474_Init((MOTOR_InitTypeDef *) init);
Davidroid 0:2887415a46cd 151 }
Davidroid 0:2887415a46cd 152
Davidroid 7:f7e0c3621f77 153 /**
Davidroid 7:f7e0c3621f77 154 * @brief Getting the ID of the component.
Davidroid 8:42e0b00b1e4d 155 * @param id Pointer to an allocated variable to store the ID into.
Davidroid 7:f7e0c3621f77 156 * @retval "0" in case of success, an error code otherwise.
Davidroid 7:f7e0c3621f77 157 */
Davidroid 0:2887415a46cd 158 virtual int ReadID(uint8_t *id)
Davidroid 0:2887415a46cd 159 {
Davidroid 0:2887415a46cd 160 return (int) L6474_ReadID((uint8_t *) id);
Davidroid 0:2887415a46cd 161 }
Davidroid 0:2887415a46cd 162
Davidroid 7:f7e0c3621f77 163 /**
Davidroid 7:f7e0c3621f77 164 * @brief Getting the value of the Status Register.
Davidroid 7:f7e0c3621f77 165 * @param None.
Davidroid 7:f7e0c3621f77 166 * @retval None.
Davidroid 7:f7e0c3621f77 167 * @note The Status Register's flags are cleared, contrary to ReadStatusRegister().
Davidroid 7:f7e0c3621f77 168 */
Davidroid 4:83a1eb397a65 169 virtual unsigned int GetStatus(void)
Davidroid 0:2887415a46cd 170 {
Davidroid 4:83a1eb397a65 171 return (unsigned int) L6474_CmdGetStatus();
Davidroid 0:2887415a46cd 172 }
Davidroid 0:2887415a46cd 173
Davidroid 7:f7e0c3621f77 174 /**
Davidroid 7:f7e0c3621f77 175 * @brief Getting a parameter.
Davidroid 8:42e0b00b1e4d 176 * @param parameter A parameter's register adress.
Davidroid 8:42e0b00b1e4d 177 * @retval The parameter's value.
Davidroid 7:f7e0c3621f77 178 * @note The Status Register's flags are cleared, contrary to ReadStatusRegister().
Davidroid 7:f7e0c3621f77 179 * parameter can be one of the following:
Davidroid 7:f7e0c3621f77 180 * + L6474_ABS_POS
Davidroid 7:f7e0c3621f77 181 * + L6474_EL_POS
Davidroid 7:f7e0c3621f77 182 * + L6474_MARK
Davidroid 7:f7e0c3621f77 183 * + L6474_RESERVED_REG01
Davidroid 7:f7e0c3621f77 184 * + L6474_RESERVED_REG02
Davidroid 7:f7e0c3621f77 185 * + L6474_RESERVED_REG03
Davidroid 7:f7e0c3621f77 186 * + L6474_RESERVED_REG04
Davidroid 7:f7e0c3621f77 187 * + L6474_RESERVED_REG05
Davidroid 7:f7e0c3621f77 188 * + L6474_RESERVED_REG06
Davidroid 7:f7e0c3621f77 189 * + L6474_TVAL
Davidroid 7:f7e0c3621f77 190 * + L6474_RESERVED_REG07
Davidroid 7:f7e0c3621f77 191 * + L6474_RESERVED_REG08
Davidroid 7:f7e0c3621f77 192 * + L6474_RESERVED_REG09
Davidroid 7:f7e0c3621f77 193 * + L6474_RESERVED_REG10
Davidroid 7:f7e0c3621f77 194 * + L6474_T_FAST
Davidroid 7:f7e0c3621f77 195 * + L6474_TON_MIN
Davidroid 7:f7e0c3621f77 196 * + L6474_TOFF_MIN
Davidroid 7:f7e0c3621f77 197 * + L6474_RESERVED_REG11
Davidroid 7:f7e0c3621f77 198 * + L6474_ADC_OUT
Davidroid 7:f7e0c3621f77 199 * + L6474_OCD_TH
Davidroid 7:f7e0c3621f77 200 * + L6474_RESERVED_REG12
Davidroid 7:f7e0c3621f77 201 * + L6474_STEP_MODE
Davidroid 7:f7e0c3621f77 202 * + L6474_ALARM_EN
Davidroid 7:f7e0c3621f77 203 * + L6474_CONFIG
Davidroid 7:f7e0c3621f77 204 * + L6474_STATUS
Davidroid 7:f7e0c3621f77 205 * + L6474_RESERVED_REG13
Davidroid 7:f7e0c3621f77 206 * + L6474_RESERVED_REG14
Davidroid 7:f7e0c3621f77 207 * + L6474_INEXISTENT_REG
Davidroid 7:f7e0c3621f77 208 */
Davidroid 4:83a1eb397a65 209 virtual unsigned int GetParameter(unsigned int parameter)
Davidroid 0:2887415a46cd 210 {
Davidroid 7:f7e0c3621f77 211 return (unsigned int) L6474_CmdGetParam((L6474_Registers_t) parameter);
Davidroid 4:83a1eb397a65 212 }
Davidroid 4:83a1eb397a65 213
Davidroid 8:42e0b00b1e4d 214 /**
Davidroid 8:42e0b00b1e4d 215 * @brief Getting the position.
Davidroid 8:42e0b00b1e4d 216 * @param None.
Davidroid 8:42e0b00b1e4d 217 * @retval The position.
Davidroid 8:42e0b00b1e4d 218 */
Davidroid 4:83a1eb397a65 219 virtual signed int GetPosition(void)
Davidroid 4:83a1eb397a65 220 {
Davidroid 4:83a1eb397a65 221 return (signed int) L6474_GetPosition();
Davidroid 0:2887415a46cd 222 }
Davidroid 0:2887415a46cd 223
Davidroid 8:42e0b00b1e4d 224 /**
Davidroid 8:42e0b00b1e4d 225 * @brief Getting the marked position.
Davidroid 8:42e0b00b1e4d 226 * @param None.
Davidroid 8:42e0b00b1e4d 227 * @retval The marked position.
Davidroid 8:42e0b00b1e4d 228 */
Davidroid 4:83a1eb397a65 229 virtual signed int GetMark(void)
Davidroid 0:2887415a46cd 230 {
Davidroid 4:83a1eb397a65 231 return (signed int) L6474_GetMark();
Davidroid 4:83a1eb397a65 232 }
Davidroid 8:42e0b00b1e4d 233
Davidroid 8:42e0b00b1e4d 234 /**
Davidroid 8:42e0b00b1e4d 235 * @brief Getting the current speed in pps.
Davidroid 8:42e0b00b1e4d 236 * @param None.
Davidroid 8:42e0b00b1e4d 237 * @retval The current speed in pps.
Davidroid 8:42e0b00b1e4d 238 */
Davidroid 4:83a1eb397a65 239 virtual unsigned int GetSpeed(void)
Davidroid 0:2887415a46cd 240 {
Davidroid 4:83a1eb397a65 241 return (unsigned int) L6474_GetCurrentSpeed();
Davidroid 0:2887415a46cd 242 }
Davidroid 0:2887415a46cd 243
Davidroid 8:42e0b00b1e4d 244 /**
Davidroid 8:42e0b00b1e4d 245 * @brief Getting the maximum speed in pps.
Davidroid 8:42e0b00b1e4d 246 * @param None.
Davidroid 8:42e0b00b1e4d 247 * @retval The maximum speed in pps.
Davidroid 8:42e0b00b1e4d 248 */
Davidroid 4:83a1eb397a65 249 virtual unsigned int GetMaxSpeed(void)
Davidroid 4:83a1eb397a65 250 {
Davidroid 4:83a1eb397a65 251 return (unsigned int) L6474_GetMaxSpeed();
Davidroid 4:83a1eb397a65 252 }
Davidroid 4:83a1eb397a65 253
Davidroid 8:42e0b00b1e4d 254 /**
Davidroid 8:42e0b00b1e4d 255 * @brief Getting the minimum speed in pps.
Davidroid 8:42e0b00b1e4d 256 * @param None.
Davidroid 8:42e0b00b1e4d 257 * @retval The minimum speed in pps.
Davidroid 8:42e0b00b1e4d 258 */
Davidroid 4:83a1eb397a65 259 virtual unsigned int GetMinSpeed(void)
Davidroid 0:2887415a46cd 260 {
Davidroid 4:83a1eb397a65 261 return (unsigned int) L6474_GetMinSpeed();
Davidroid 4:83a1eb397a65 262 }
Davidroid 4:83a1eb397a65 263
Davidroid 8:42e0b00b1e4d 264 /**
Davidroid 8:42e0b00b1e4d 265 * @brief Getting the acceleration in pps^2.
Davidroid 8:42e0b00b1e4d 266 * @param None.
Davidroid 8:42e0b00b1e4d 267 * @retval The acceleration in pps^2.
Davidroid 8:42e0b00b1e4d 268 */
Davidroid 4:83a1eb397a65 269 virtual unsigned int GetAcceleration(void)
Davidroid 4:83a1eb397a65 270 {
Davidroid 4:83a1eb397a65 271 return (unsigned int) L6474_GetAcceleration();
Davidroid 0:2887415a46cd 272 }
Davidroid 0:2887415a46cd 273
Davidroid 8:42e0b00b1e4d 274 /**
Davidroid 8:42e0b00b1e4d 275 * @brief Getting the deceleration in pps^2.
Davidroid 8:42e0b00b1e4d 276 * @param None.
Davidroid 8:42e0b00b1e4d 277 * @retval The deceleration in pps^2.
Davidroid 8:42e0b00b1e4d 278 */
Davidroid 4:83a1eb397a65 279 virtual unsigned int GetDeceleration(void)
Davidroid 0:2887415a46cd 280 {
Davidroid 4:83a1eb397a65 281 return (unsigned int) L6474_GetDeceleration();
Davidroid 0:2887415a46cd 282 }
Davidroid 0:2887415a46cd 283
Davidroid 8:42e0b00b1e4d 284 /**
Davidroid 8:42e0b00b1e4d 285 * @brief Getting the direction of rotation.
Davidroid 8:42e0b00b1e4d 286 * @param None.
Davidroid 8:42e0b00b1e4d 287 * @retval The direction of rotation.
Davidroid 8:42e0b00b1e4d 288 */
Davidroid 5:d3c78f12a78d 289 virtual direction_t GetDirection(void)
Davidroid 5:d3c78f12a78d 290 {
Davidroid 5:d3c78f12a78d 291 return (direction_t) (L6474_GetDirection() == FORWARD ? StepperMotor::FWD : StepperMotor::BWD);
Davidroid 5:d3c78f12a78d 292 }
Davidroid 5:d3c78f12a78d 293
Davidroid 7:f7e0c3621f77 294 /**
Davidroid 7:f7e0c3621f77 295 * @brief Setting a parameter.
Davidroid 8:42e0b00b1e4d 296 * @param parameter A parameter's register adress.
Davidroid 8:42e0b00b1e4d 297 * @param value The parameter's value.
Davidroid 7:f7e0c3621f77 298 * @retval None.
Davidroid 7:f7e0c3621f77 299 * @note parameter can be one of the following:
Davidroid 7:f7e0c3621f77 300 * + L6474_ABS_POS
Davidroid 7:f7e0c3621f77 301 * + L6474_EL_POS
Davidroid 7:f7e0c3621f77 302 * + L6474_MARK
Davidroid 7:f7e0c3621f77 303 * + L6474_RESERVED_REG01
Davidroid 7:f7e0c3621f77 304 * + L6474_RESERVED_REG02
Davidroid 7:f7e0c3621f77 305 * + L6474_RESERVED_REG03
Davidroid 7:f7e0c3621f77 306 * + L6474_RESERVED_REG04
Davidroid 7:f7e0c3621f77 307 * + L6474_RESERVED_REG05
Davidroid 7:f7e0c3621f77 308 * + L6474_RESERVED_REG06
Davidroid 7:f7e0c3621f77 309 * + L6474_TVAL
Davidroid 7:f7e0c3621f77 310 * + L6474_RESERVED_REG07
Davidroid 7:f7e0c3621f77 311 * + L6474_RESERVED_REG08
Davidroid 7:f7e0c3621f77 312 * + L6474_RESERVED_REG09
Davidroid 7:f7e0c3621f77 313 * + L6474_RESERVED_REG10
Davidroid 7:f7e0c3621f77 314 * + L6474_T_FAST
Davidroid 7:f7e0c3621f77 315 * + L6474_TON_MIN
Davidroid 7:f7e0c3621f77 316 * + L6474_TOFF_MIN
Davidroid 7:f7e0c3621f77 317 * + L6474_RESERVED_REG11
Davidroid 7:f7e0c3621f77 318 * + L6474_ADC_OUT
Davidroid 7:f7e0c3621f77 319 * + L6474_OCD_TH
Davidroid 7:f7e0c3621f77 320 * + L6474_RESERVED_REG12
Davidroid 7:f7e0c3621f77 321 * + L6474_STEP_MODE
Davidroid 7:f7e0c3621f77 322 * + L6474_ALARM_EN
Davidroid 7:f7e0c3621f77 323 * + L6474_CONFIG
Davidroid 7:f7e0c3621f77 324 * + L6474_STATUS
Davidroid 7:f7e0c3621f77 325 * + L6474_RESERVED_REG13
Davidroid 7:f7e0c3621f77 326 * + L6474_RESERVED_REG14
Davidroid 7:f7e0c3621f77 327 * + L6474_INEXISTENT_REG
Davidroid 7:f7e0c3621f77 328 */
Davidroid 4:83a1eb397a65 329 virtual void SetParameter(unsigned int parameter, unsigned int value)
Davidroid 0:2887415a46cd 330 {
Davidroid 7:f7e0c3621f77 331 L6474_CmdSetParam((L6474_Registers_t) parameter, (unsigned int) value);
Davidroid 0:2887415a46cd 332 }
Davidroid 0:2887415a46cd 333
Davidroid 8:42e0b00b1e4d 334 /**
Davidroid 8:42e0b00b1e4d 335 * @brief Setting the current position to be the home position.
Davidroid 8:42e0b00b1e4d 336 * @param None.
Davidroid 8:42e0b00b1e4d 337 * @retval None.
Davidroid 8:42e0b00b1e4d 338 */
Davidroid 4:83a1eb397a65 339 virtual void SetHome(void)
Davidroid 0:2887415a46cd 340 {
Davidroid 4:83a1eb397a65 341 L6474_SetHome();
Davidroid 4:83a1eb397a65 342 }
Davidroid 4:83a1eb397a65 343
Davidroid 8:42e0b00b1e4d 344 /**
Davidroid 8:42e0b00b1e4d 345 * @brief Setting the current position to be the marked position.
Davidroid 8:42e0b00b1e4d 346 * @param None.
Davidroid 8:42e0b00b1e4d 347 * @retval None.
Davidroid 8:42e0b00b1e4d 348 */
Davidroid 4:83a1eb397a65 349 virtual void SetMark(void)
Davidroid 4:83a1eb397a65 350 {
Davidroid 4:83a1eb397a65 351 L6474_SetMark();
Davidroid 0:2887415a46cd 352 }
Davidroid 0:2887415a46cd 353
Davidroid 8:42e0b00b1e4d 354 /**
Davidroid 8:42e0b00b1e4d 355 * @brief Setting the maximum speed in pps.
Davidroid 8:42e0b00b1e4d 356 * @param speed The maximum speed in pps.
Davidroid 8:42e0b00b1e4d 357 * @retval None.
Davidroid 8:42e0b00b1e4d 358 */
Davidroid 4:83a1eb397a65 359 virtual void SetMaxSpeed(unsigned int speed)
Davidroid 4:83a1eb397a65 360 {
Davidroid 4:83a1eb397a65 361 L6474_SetMaxSpeed((unsigned int) speed);
Davidroid 0:2887415a46cd 362 }
Davidroid 0:2887415a46cd 363
Davidroid 8:42e0b00b1e4d 364 /**
Davidroid 8:42e0b00b1e4d 365 * @brief Setting the minimum speed in pps.
Davidroid 8:42e0b00b1e4d 366 * @param speed The minimum speed in pps.
Davidroid 8:42e0b00b1e4d 367 * @retval None.
Davidroid 8:42e0b00b1e4d 368 */
Davidroid 4:83a1eb397a65 369 virtual void SetMinSpeed(unsigned int speed)
Davidroid 0:2887415a46cd 370 {
Davidroid 4:83a1eb397a65 371 L6474_SetMinSpeed((unsigned int) speed);
Davidroid 0:2887415a46cd 372 }
Davidroid 0:2887415a46cd 373
Davidroid 8:42e0b00b1e4d 374 /**
Davidroid 8:42e0b00b1e4d 375 * @brief Setting the acceleration in pps^2.
Davidroid 8:42e0b00b1e4d 376 * @param acceleration The acceleration in pps^2.
Davidroid 8:42e0b00b1e4d 377 * @retval None.
Davidroid 8:42e0b00b1e4d 378 */
Davidroid 4:83a1eb397a65 379 virtual void SetAcceleration(unsigned int acceleration)
Davidroid 0:2887415a46cd 380 {
Davidroid 4:83a1eb397a65 381 L6474_SetAcceleration((unsigned int) acceleration);
Davidroid 0:2887415a46cd 382 }
Davidroid 0:2887415a46cd 383
Davidroid 8:42e0b00b1e4d 384 /**
Davidroid 8:42e0b00b1e4d 385 * @brief Setting the deceleration in pps^2.
Davidroid 8:42e0b00b1e4d 386 * @param deceleration The deceleration in pps^2.
Davidroid 8:42e0b00b1e4d 387 * @retval None.
Davidroid 8:42e0b00b1e4d 388 */
Davidroid 4:83a1eb397a65 389 virtual void SetDeceleration(unsigned int deceleration)
Davidroid 0:2887415a46cd 390 {
Davidroid 4:83a1eb397a65 391 L6474_SetDeceleration((unsigned int) deceleration);
Davidroid 4:83a1eb397a65 392 }
Davidroid 4:83a1eb397a65 393
Davidroid 8:42e0b00b1e4d 394 /**
Davidroid 8:42e0b00b1e4d 395 * @brief Going to a specified position.
Davidroid 8:42e0b00b1e4d 396 * @param position The desired position.
Davidroid 8:42e0b00b1e4d 397 * @retval None.
Davidroid 8:42e0b00b1e4d 398 */
Davidroid 4:83a1eb397a65 399 virtual void GoTo(signed int position)
Davidroid 4:83a1eb397a65 400 {
Davidroid 4:83a1eb397a65 401 L6474_GoTo((signed int) position);
Davidroid 0:2887415a46cd 402 }
Davidroid 0:2887415a46cd 403
Davidroid 8:42e0b00b1e4d 404 /**
Davidroid 8:42e0b00b1e4d 405 * @brief Going to the home position.
Davidroid 8:42e0b00b1e4d 406 * @param None.
Davidroid 8:42e0b00b1e4d 407 * @retval None.
Davidroid 8:42e0b00b1e4d 408 */
Davidroid 0:2887415a46cd 409 virtual void GoHome(void)
Davidroid 0:2887415a46cd 410 {
Davidroid 0:2887415a46cd 411 L6474_GoHome();
Davidroid 0:2887415a46cd 412 }
Davidroid 0:2887415a46cd 413
Davidroid 8:42e0b00b1e4d 414 /**
Davidroid 8:42e0b00b1e4d 415 * @brief Going to the marked position.
Davidroid 8:42e0b00b1e4d 416 * @param None.
Davidroid 8:42e0b00b1e4d 417 * @retval None.
Davidroid 8:42e0b00b1e4d 418 */
Davidroid 0:2887415a46cd 419 virtual void GoMark(void)
Davidroid 0:2887415a46cd 420 {
Davidroid 0:2887415a46cd 421 L6474_GoMark();
Davidroid 0:2887415a46cd 422 }
Davidroid 0:2887415a46cd 423
Davidroid 8:42e0b00b1e4d 424 /**
Davidroid 8:42e0b00b1e4d 425 * @brief Running the motor towards a specified direction.
Davidroid 8:42e0b00b1e4d 426 * @param direction The direction of rotation.
Davidroid 8:42e0b00b1e4d 427 * @retval None.
Davidroid 8:42e0b00b1e4d 428 */
Davidroid 4:83a1eb397a65 429 virtual void Run(direction_t direction)
Davidroid 4:83a1eb397a65 430 {
Davidroid 5:d3c78f12a78d 431 L6474_Run((motorDir_t) (direction == StepperMotor::FWD ? FORWARD : BACKWARD));
Davidroid 4:83a1eb397a65 432 }
Davidroid 4:83a1eb397a65 433
Davidroid 8:42e0b00b1e4d 434 /**
Davidroid 8:42e0b00b1e4d 435 * @brief Moving the motor towards a specified direction for a certain number of steps.
Davidroid 8:42e0b00b1e4d 436 * @param direction The direction of rotation.
Davidroid 8:42e0b00b1e4d 437 * @param steps The desired number of steps.
Davidroid 8:42e0b00b1e4d 438 * @retval None.
Davidroid 8:42e0b00b1e4d 439 */
Davidroid 4:83a1eb397a65 440 virtual void Move(direction_t direction, unsigned int steps)
Davidroid 0:2887415a46cd 441 {
Davidroid 5:d3c78f12a78d 442 L6474_Move((motorDir_t) (direction == StepperMotor::FWD ? FORWARD : BACKWARD), (unsigned int) steps);
Davidroid 4:83a1eb397a65 443 }
Davidroid 4:83a1eb397a65 444
Davidroid 8:42e0b00b1e4d 445 /**
Davidroid 13:ba2728afe4c2 446 * @brief Stopping the motor through an immediate deceleration up to zero speed.
Davidroid 8:42e0b00b1e4d 447 * @param None.
Davidroid 8:42e0b00b1e4d 448 * @retval None.
Davidroid 8:42e0b00b1e4d 449 */
Davidroid 4:83a1eb397a65 450 virtual void SoftStop(void)
Davidroid 4:83a1eb397a65 451 {
Davidroid 4:83a1eb397a65 452 L6474_SoftStop();
Davidroid 0:2887415a46cd 453 }
Davidroid 0:2887415a46cd 454
Davidroid 8:42e0b00b1e4d 455 /**
Davidroid 13:ba2728afe4c2 456 * @brief Stopping the motor through an immediate infinite deceleration.
Davidroid 8:42e0b00b1e4d 457 * @param None.
Davidroid 8:42e0b00b1e4d 458 * @retval None.
Davidroid 8:42e0b00b1e4d 459 */
Davidroid 0:2887415a46cd 460 virtual void HardStop(void)
Davidroid 0:2887415a46cd 461 {
Davidroid 0:2887415a46cd 462 L6474_HardStop();
Davidroid 0:2887415a46cd 463 }
Davidroid 0:2887415a46cd 464
Davidroid 8:42e0b00b1e4d 465 /**
Davidroid 13:ba2728afe4c2 466 * @brief Disabling the power bridge after performing a deceleration to zero.
Davidroid 13:ba2728afe4c2 467 * @param None.
Davidroid 13:ba2728afe4c2 468 * @retval None.
Davidroid 13:ba2728afe4c2 469 */
Davidroid 13:ba2728afe4c2 470 virtual void SoftHiZ(void)
Davidroid 13:ba2728afe4c2 471 {
Davidroid 13:ba2728afe4c2 472 L6474_SoftStop();
Davidroid 13:ba2728afe4c2 473 L6474_CmdDisable();
Davidroid 13:ba2728afe4c2 474 }
Davidroid 13:ba2728afe4c2 475
Davidroid 13:ba2728afe4c2 476 /**
Davidroid 13:ba2728afe4c2 477 * @brief Disabling the power bridge immediately.
Davidroid 13:ba2728afe4c2 478 * @param None.
Davidroid 13:ba2728afe4c2 479 * @retval None.
Davidroid 13:ba2728afe4c2 480 */
Davidroid 13:ba2728afe4c2 481 virtual void HardHiZ(void)
Davidroid 13:ba2728afe4c2 482 {
Davidroid 13:ba2728afe4c2 483 L6474_HardStop();
Davidroid 13:ba2728afe4c2 484 L6474_CmdDisable();
Davidroid 13:ba2728afe4c2 485 }
Davidroid 13:ba2728afe4c2 486
Davidroid 13:ba2728afe4c2 487 /**
Davidroid 8:42e0b00b1e4d 488 * @brief Waiting while the motor is active.
Davidroid 8:42e0b00b1e4d 489 * @param None.
Davidroid 8:42e0b00b1e4d 490 * @retval None.
Davidroid 8:42e0b00b1e4d 491 */
Davidroid 7:f7e0c3621f77 492 virtual void WaitWhileActive(void)
Davidroid 7:f7e0c3621f77 493 {
Davidroid 7:f7e0c3621f77 494 L6474_WaitWhileActive();
Davidroid 7:f7e0c3621f77 495 }
Davidroid 7:f7e0c3621f77 496
Davidroid 7:f7e0c3621f77 497 /**
Davidroid 7:f7e0c3621f77 498 * @brief Getting the device state.
Davidroid 7:f7e0c3621f77 499 * @param None.
Davidroid 7:f7e0c3621f77 500 * @retval The device state.
Davidroid 7:f7e0c3621f77 501 * @note The device state can be one of the following:
Davidroid 7:f7e0c3621f77 502 * + ACCELERATING
Davidroid 7:f7e0c3621f77 503 * + DECELERATING
Davidroid 7:f7e0c3621f77 504 * + STEADY
Davidroid 7:f7e0c3621f77 505 * + INACTIVE
Davidroid 7:f7e0c3621f77 506 */
Davidroid 4:83a1eb397a65 507 virtual motorState_t GetDeviceState(void)
Davidroid 0:2887415a46cd 508 {
Davidroid 4:83a1eb397a65 509 return (motorState_t) L6474_GetDeviceState();
Davidroid 0:2887415a46cd 510 }
Davidroid 0:2887415a46cd 511
Davidroid 7:f7e0c3621f77 512 /**
Davidroid 7:f7e0c3621f77 513 * @brief Reading the Status Register.
Davidroid 7:f7e0c3621f77 514 * @param None.
Davidroid 7:f7e0c3621f77 515 * @retval None.
Davidroid 7:f7e0c3621f77 516 * @note The Status Register's flags are not cleared, contrary to GetStatus().
Davidroid 7:f7e0c3621f77 517 */
Davidroid 0:2887415a46cd 518 virtual uint16_t ReadStatusRegister(void)
Davidroid 0:2887415a46cd 519 {
Davidroid 0:2887415a46cd 520 return (uint16_t) L6474_ReadStatusRegister();
Davidroid 0:2887415a46cd 521 }
Davidroid 0:2887415a46cd 522
Davidroid 7:f7e0c3621f77 523 /**
Davidroid 8:42e0b00b1e4d 524 * @brief Setting the Step Mode.
Davidroid 8:42e0b00b1e4d 525 * @param step_mode The Step Mode.
Davidroid 7:f7e0c3621f77 526 * @retval None.
Davidroid 7:f7e0c3621f77 527 * @note step_mode can be one of the following:
Davidroid 7:f7e0c3621f77 528 * + STEP_MODE_FULL
Davidroid 7:f7e0c3621f77 529 * + STEP_MODE_HALF
Davidroid 7:f7e0c3621f77 530 * + STEP_MODE_1_4
Davidroid 7:f7e0c3621f77 531 * + STEP_MODE_1_8
Davidroid 7:f7e0c3621f77 532 * + STEP_MODE_1_16
Davidroid 7:f7e0c3621f77 533 * + STEP_MODE_1_32
Davidroid 7:f7e0c3621f77 534 * + STEP_MODE_1_64
Davidroid 7:f7e0c3621f77 535 * + STEP_MODE_1_128
Davidroid 7:f7e0c3621f77 536 */
Davidroid 8:42e0b00b1e4d 537 virtual void SetStepMode(motorStepMode_t step_mode)
Davidroid 0:2887415a46cd 538 {
Davidroid 7:f7e0c3621f77 539 L6474_SelectStepMode((motorStepMode_t) step_mode);
Davidroid 0:2887415a46cd 540 }
Davidroid 0:2887415a46cd 541
Davidroid 7:f7e0c3621f77 542 /**
Davidroid 7:f7e0c3621f77 543 * @brief Attaching an error handler.
Davidroid 8:42e0b00b1e4d 544 * @param fptr An error handler.
Davidroid 7:f7e0c3621f77 545 * @retval None.
Davidroid 7:f7e0c3621f77 546 */
Davidroid 7:f7e0c3621f77 547 virtual void AttachErrorHandler(void (*fptr)(uint16_t error))
Davidroid 4:83a1eb397a65 548 {
Davidroid 7:f7e0c3621f77 549 L6474_AttachErrorHandler((void (*)(uint16_t error)) fptr);
Davidroid 4:83a1eb397a65 550 }
Davidroid 4:83a1eb397a65 551
Davidroid 9:6f116ce8e314 552 /**
Davidroid 8:42e0b00b1e4d 553 * @brief Enabling the device.
Davidroid 8:42e0b00b1e4d 554 * @param None.
Davidroid 8:42e0b00b1e4d 555 * @retval None.
Davidroid 8:42e0b00b1e4d 556 */
Davidroid 8:42e0b00b1e4d 557 virtual void Enable(void)
Davidroid 8:42e0b00b1e4d 558 {
Davidroid 8:42e0b00b1e4d 559 L6474_CmdEnable();
Davidroid 8:42e0b00b1e4d 560 }
Davidroid 8:42e0b00b1e4d 561
Davidroid 9:6f116ce8e314 562 /**
Davidroid 8:42e0b00b1e4d 563 * @brief Disabling the device.
Davidroid 8:42e0b00b1e4d 564 * @param None.
Davidroid 8:42e0b00b1e4d 565 * @retval None.
Davidroid 8:42e0b00b1e4d 566 */
Davidroid 8:42e0b00b1e4d 567 virtual void Disable(void)
Davidroid 8:42e0b00b1e4d 568 {
Davidroid 8:42e0b00b1e4d 569 L6474_CmdDisable();
Davidroid 8:42e0b00b1e4d 570 }
Davidroid 8:42e0b00b1e4d 571
Davidroid 9:6f116ce8e314 572 /**
Davidroid 9:6f116ce8e314 573 * @brief Getting the version of the firmware.
Davidroid 9:6f116ce8e314 574 * @param None.
Davidroid 9:6f116ce8e314 575 * @retval The version of the firmware.
Davidroid 9:6f116ce8e314 576 */
Davidroid 9:6f116ce8e314 577 virtual uint8_t GetFwVersion(void)
Davidroid 9:6f116ce8e314 578 {
Davidroid 9:6f116ce8e314 579 return (uint8_t) L6474_GetFwVersion();
Davidroid 9:6f116ce8e314 580 }
Davidroid 9:6f116ce8e314 581
Davidroid 0:2887415a46cd 582
Davidroid 0:2887415a46cd 583 /*** Public Interrupt Related Methods ***/
Davidroid 0:2887415a46cd 584
Davidroid 0:2887415a46cd 585 /* ACTION 6 --------------------------------------------------------------*
Davidroid 0:2887415a46cd 586 * Implement here interrupt related methods, if any. *
Davidroid 0:2887415a46cd 587 * Note that interrupt handling is platform dependent, e.g.: *
Davidroid 0:2887415a46cd 588 * + mbed: *
Davidroid 7:f7e0c3621f77 589 * InterruptIn feature_irq(pin); //Interrupt object. *
Davidroid 7:f7e0c3621f77 590 * feature_irq.rise(callback); //Attach a callback. *
Davidroid 7:f7e0c3621f77 591 * feature_irq.mode(PullNone); //Set interrupt mode. *
Davidroid 7:f7e0c3621f77 592 * feature_irq.enable_irq(); //Enable interrupt. *
Davidroid 7:f7e0c3621f77 593 * feature_irq.disable_irq(); //Disable interrupt. *
Davidroid 0:2887415a46cd 594 * + Arduino: *
Davidroid 0:2887415a46cd 595 * attachInterrupt(pin, callback, RISING); //Attach a callback. *
Davidroid 0:2887415a46cd 596 * detachInterrupt(pin); //Detach a callback. *
Davidroid 0:2887415a46cd 597 * *
Davidroid 0:2887415a46cd 598 * Example (mbed): *
Davidroid 7:f7e0c3621f77 599 * void AttachFeatureIRQ(void (*fptr) (void)) *
Davidroid 0:2887415a46cd 600 * { *
Davidroid 7:f7e0c3621f77 601 * feature_irq.rise(fptr); *
Davidroid 7:f7e0c3621f77 602 * } *
Davidroid 7:f7e0c3621f77 603 * *
Davidroid 7:f7e0c3621f77 604 * void EnableFeatureIRQ(void) *
Davidroid 7:f7e0c3621f77 605 * { *
Davidroid 7:f7e0c3621f77 606 * feature_irq.enable_irq(); *
Davidroid 0:2887415a46cd 607 * } *
Davidroid 0:2887415a46cd 608 * *
Davidroid 7:f7e0c3621f77 609 * void DisableFeatureIRQ(void) *
Davidroid 0:2887415a46cd 610 * { *
Davidroid 7:f7e0c3621f77 611 * feature_irq.disable_irq(); *
Davidroid 0:2887415a46cd 612 * } *
Davidroid 0:2887415a46cd 613 *------------------------------------------------------------------------*/
Davidroid 7:f7e0c3621f77 614 /**
Davidroid 8:42e0b00b1e4d 615 * @brief Attaching an interrupt handler to the FLAG interrupt.
Davidroid 8:42e0b00b1e4d 616 * @param fptr An interrupt handler.
Davidroid 7:f7e0c3621f77 617 * @retval None.
Davidroid 7:f7e0c3621f77 618 */
Davidroid 7:f7e0c3621f77 619 void AttachFlagIRQ(void (*fptr)(void))
Davidroid 7:f7e0c3621f77 620 {
Davidroid 7:f7e0c3621f77 621 flag_irq.rise(fptr);
Davidroid 7:f7e0c3621f77 622 }
Davidroid 7:f7e0c3621f77 623
Davidroid 7:f7e0c3621f77 624 /**
Davidroid 8:42e0b00b1e4d 625 * @brief Enabling the FLAG interrupt handling.
Davidroid 7:f7e0c3621f77 626 * @param None.
Davidroid 7:f7e0c3621f77 627 * @retval None.
Davidroid 7:f7e0c3621f77 628 */
Davidroid 7:f7e0c3621f77 629 void EnableFlagIRQ(void)
Davidroid 7:f7e0c3621f77 630 {
Davidroid 7:f7e0c3621f77 631 flag_irq.enable_irq();
Davidroid 7:f7e0c3621f77 632 }
Davidroid 7:f7e0c3621f77 633
Davidroid 7:f7e0c3621f77 634 /**
Davidroid 8:42e0b00b1e4d 635 * @brief Disabling the FLAG interrupt handling.
Davidroid 7:f7e0c3621f77 636 * @param None.
Davidroid 7:f7e0c3621f77 637 * @retval None.
Davidroid 7:f7e0c3621f77 638 */
Davidroid 7:f7e0c3621f77 639 void DisableFlagIRQ(void)
Davidroid 7:f7e0c3621f77 640 {
Davidroid 7:f7e0c3621f77 641 flag_irq.disable_irq();
Davidroid 7:f7e0c3621f77 642 }
Davidroid 0:2887415a46cd 643
Davidroid 0:2887415a46cd 644
Davidroid 0:2887415a46cd 645 protected:
Davidroid 0:2887415a46cd 646
Davidroid 0:2887415a46cd 647 /*** Protected Component Related Methods ***/
Davidroid 0:2887415a46cd 648
Davidroid 0:2887415a46cd 649 /* ACTION 7 --------------------------------------------------------------*
Davidroid 0:2887415a46cd 650 * Declare here the component's specific methods. *
Davidroid 0:2887415a46cd 651 * They should be: *
Davidroid 0:2887415a46cd 652 * + Methods with the same name of the C component's virtual table's *
Davidroid 0:2887415a46cd 653 * functions (1); *
Davidroid 0:2887415a46cd 654 * + Methods with the same name of the C component's extended virtual *
Davidroid 0:2887415a46cd 655 * table's functions, if any (2); *
Davidroid 0:2887415a46cd 656 * + Helper methods, if any, like functions declared in the component's *
Davidroid 0:2887415a46cd 657 * source files but not pointed by the component's virtual table (3). *
Davidroid 0:2887415a46cd 658 * *
Davidroid 0:2887415a46cd 659 * Example: *
Davidroid 0:2887415a46cd 660 * DrvStatusTypeDef COMPONENT_GetValue(float* pfData); //(1) *
Davidroid 0:2887415a46cd 661 * DrvStatusTypeDef COMPONENT_EnableFeature(void); //(2) *
Davidroid 0:2887415a46cd 662 * DrvStatusTypeDef COMPONENT_ComputeAverage(void); //(3) *
Davidroid 0:2887415a46cd 663 *------------------------------------------------------------------------*/
Davidroid 7:f7e0c3621f77 664 void L6474_AttachErrorHandler(void (*callback)(uint16_t error));
Davidroid 7:f7e0c3621f77 665 DrvStatusTypeDef L6474_Init(MOTOR_InitTypeDef *init);
Davidroid 7:f7e0c3621f77 666 DrvStatusTypeDef L6474_ReadID(uint8_t *id);
Davidroid 7:f7e0c3621f77 667 uint16_t L6474_GetAcceleration(void);
Davidroid 7:f7e0c3621f77 668 uint16_t L6474_GetCurrentSpeed(void);
Davidroid 7:f7e0c3621f77 669 uint16_t L6474_GetDeceleration(void);
Davidroid 7:f7e0c3621f77 670 motorState_t L6474_GetDeviceState(void);
Davidroid 7:f7e0c3621f77 671 uint8_t L6474_GetFwVersion(void);
Davidroid 7:f7e0c3621f77 672 int32_t L6474_GetMark(void);
Davidroid 7:f7e0c3621f77 673 uint16_t L6474_GetMaxSpeed(void);
Davidroid 7:f7e0c3621f77 674 uint16_t L6474_GetMinSpeed(void);
Davidroid 7:f7e0c3621f77 675 int32_t L6474_GetPosition(void);
Davidroid 7:f7e0c3621f77 676 void L6474_GoHome(void);
Davidroid 7:f7e0c3621f77 677 void L6474_GoMark(void);
Davidroid 7:f7e0c3621f77 678 void L6474_GoTo(int32_t targetPosition);
Davidroid 7:f7e0c3621f77 679 void L6474_HardStop(void);
Davidroid 7:f7e0c3621f77 680 void L6474_Move(motorDir_t direction, uint32_t stepCount);
Davidroid 7:f7e0c3621f77 681 void L6474_Run(motorDir_t direction);
Davidroid 7:f7e0c3621f77 682 bool L6474_SetAcceleration(uint16_t newAcc);
Davidroid 7:f7e0c3621f77 683 bool L6474_SetDeceleration(uint16_t newDec);
Davidroid 7:f7e0c3621f77 684 void L6474_SetHome(void);
Davidroid 7:f7e0c3621f77 685 void L6474_SetMark(void);
Davidroid 7:f7e0c3621f77 686 bool L6474_SetMaxSpeed(uint16_t newMaxSpeed);
Davidroid 7:f7e0c3621f77 687 bool L6474_SetMinSpeed(uint16_t newMinSpeed);
Davidroid 7:f7e0c3621f77 688 bool L6474_SoftStop(void);
Davidroid 7:f7e0c3621f77 689 void L6474_WaitWhileActive(void);
Davidroid 7:f7e0c3621f77 690 void L6474_CmdDisable(void);
Davidroid 7:f7e0c3621f77 691 void L6474_CmdEnable(void);
Davidroid 7:f7e0c3621f77 692 uint32_t L6474_CmdGetParam(L6474_Registers_t parameter);
Davidroid 7:f7e0c3621f77 693 uint16_t L6474_CmdGetStatus(void);
Davidroid 7:f7e0c3621f77 694 void L6474_CmdNop(void);
Davidroid 7:f7e0c3621f77 695 void L6474_CmdSetParam(L6474_Registers_t parameter, uint32_t value);
Davidroid 7:f7e0c3621f77 696 uint16_t L6474_ReadStatusRegister(void);
Davidroid 7:f7e0c3621f77 697 void L6474_SelectStepMode(motorStepMode_t stepMod);
Davidroid 7:f7e0c3621f77 698 motorDir_t L6474_GetDirection(void);
Davidroid 7:f7e0c3621f77 699 void L6474_SetDirection(motorDir_t direction);
Davidroid 0:2887415a46cd 700 void L6474_ApplySpeed(uint16_t newSpeed);
Davidroid 0:2887415a46cd 701 void L6474_ComputeSpeedProfile(uint32_t nbSteps);
Davidroid 7:f7e0c3621f77 702 int32_t L6474_ConvertPosition(uint32_t abs_position_reg);
Davidroid 0:2887415a46cd 703 void L6474_ErrorHandler(uint16_t error);
Davidroid 0:2887415a46cd 704 void L6474_SendCommand(uint8_t param);
Davidroid 0:2887415a46cd 705 void L6474_SetRegisterToPredefinedValues(void);
Davidroid 7:f7e0c3621f77 706 void L6474_WriteBytes(uint8_t *pByteToTransmit, uint8_t *pReceivedByte);
Davidroid 0:2887415a46cd 707 void L6474_SetDeviceParamsToPredefinedValues(void);
Davidroid 0:2887415a46cd 708 void L6474_StartMovement(void);
Davidroid 7:f7e0c3621f77 709 void L6474_StepClockHandler(void);
Davidroid 0:2887415a46cd 710 uint8_t L6474_Tval_Current_to_Par(double Tval);
Davidroid 0:2887415a46cd 711 uint8_t L6474_Tmin_Time_to_Par(double Tmin);
Davidroid 0:2887415a46cd 712
Davidroid 0:2887415a46cd 713
Davidroid 0:2887415a46cd 714 /*** Component's I/O Methods ***/
Davidroid 0:2887415a46cd 715
Davidroid 0:2887415a46cd 716 /**
Davidroid 0:2887415a46cd 717 * @brief Utility function to read data from L6474.
Davidroid 0:2887415a46cd 718 * @param[out] pBuffer pointer to the buffer to read data into.
Davidroid 0:2887415a46cd 719 * @param[in] NumBytesToRead number of bytes to read.
Davidroid 0:2887415a46cd 720 * @retval COMPONENT_OK in case of success, COMPONENT_ERROR otherwise.
Davidroid 0:2887415a46cd 721 */
Davidroid 0:2887415a46cd 722 DrvStatusTypeDef Read(uint8_t* pBuffer, uint16_t NumBytesToRead)
Davidroid 0:2887415a46cd 723 {
Davidroid 0:2887415a46cd 724 if (dev_spi.spi_read(pBuffer, ssel, NumBytesToRead) != 0)
Davidroid 0:2887415a46cd 725 return COMPONENT_ERROR;
Davidroid 0:2887415a46cd 726 return COMPONENT_OK;
Davidroid 0:2887415a46cd 727 }
Davidroid 0:2887415a46cd 728
Davidroid 0:2887415a46cd 729 /**
Davidroid 0:2887415a46cd 730 * @brief Utility function to write data to L6474.
Davidroid 0:2887415a46cd 731 * @param[in] pBuffer pointer to the buffer of data to send.
Davidroid 0:2887415a46cd 732 * @param[in] NumBytesToWrite number of bytes to write.
Davidroid 0:2887415a46cd 733 * @retval COMPONENT_OK in case of success, COMPONENT_ERROR otherwise.
Davidroid 0:2887415a46cd 734 */
Davidroid 0:2887415a46cd 735 DrvStatusTypeDef Write(uint8_t* pBuffer, uint16_t NumBytesToWrite)
Davidroid 0:2887415a46cd 736 {
Davidroid 0:2887415a46cd 737 if (dev_spi.spi_write(pBuffer, ssel, NumBytesToWrite) != 0)
Davidroid 0:2887415a46cd 738 return COMPONENT_ERROR;
Davidroid 0:2887415a46cd 739 return COMPONENT_OK;
Davidroid 0:2887415a46cd 740 }
Davidroid 0:2887415a46cd 741
Davidroid 0:2887415a46cd 742 /**
Davidroid 0:2887415a46cd 743 * @brief Utility function to read and write data from/to L6474 at the same time.
Davidroid 0:2887415a46cd 744 * @param[out] pBufferToRead pointer to the buffer to read data into.
Davidroid 0:2887415a46cd 745 * @param[in] pBufferToWrite pointer to the buffer of data to send.
Davidroid 0:2887415a46cd 746 * @param[in] NumBytes number of bytes to read and write.
Davidroid 0:2887415a46cd 747 * @retval COMPONENT_OK in case of success, COMPONENT_ERROR otherwise.
Davidroid 0:2887415a46cd 748 */
Davidroid 0:2887415a46cd 749 DrvStatusTypeDef ReadWrite(uint8_t* pBufferToRead, uint8_t* pBufferToWrite, uint16_t NumBytes)
Davidroid 0:2887415a46cd 750 {
Davidroid 0:2887415a46cd 751 if (dev_spi.spi_read_write(pBufferToRead, pBufferToWrite, ssel, NumBytes) != 0)
Davidroid 0:2887415a46cd 752 return COMPONENT_ERROR;
Davidroid 0:2887415a46cd 753 return COMPONENT_OK;
Davidroid 0:2887415a46cd 754 }
Davidroid 0:2887415a46cd 755
Davidroid 0:2887415a46cd 756 /* ACTION 8 --------------------------------------------------------------*
Davidroid 0:2887415a46cd 757 * Implement here other I/O methods beyond those already implemented *
Davidroid 0:2887415a46cd 758 * above, which are declared extern within the component's header file. *
Davidroid 0:2887415a46cd 759 *------------------------------------------------------------------------*/
Davidroid 7:f7e0c3621f77 760 /**
Davidroid 7:f7e0c3621f77 761 * @brief Making the CPU wait.
Davidroid 7:f7e0c3621f77 762 * @param None.
Davidroid 7:f7e0c3621f77 763 * @retval None.
Davidroid 0:2887415a46cd 764 */
Davidroid 0:2887415a46cd 765 void L6474_Delay(uint32_t delay)
Davidroid 0:2887415a46cd 766 {
Davidroid 0:2887415a46cd 767 wait_ms(delay);
Davidroid 0:2887415a46cd 768 }
Davidroid 0:2887415a46cd 769
Davidroid 7:f7e0c3621f77 770 /**
Davidroid 7:f7e0c3621f77 771 * @brief Enabling interrupts.
Davidroid 7:f7e0c3621f77 772 * @param None.
Davidroid 7:f7e0c3621f77 773 * @retval None.
Davidroid 0:2887415a46cd 774 */
Davidroid 0:2887415a46cd 775 void L6474_EnableIrq(void)
Davidroid 0:2887415a46cd 776 {
Davidroid 0:2887415a46cd 777 __enable_irq();
Davidroid 0:2887415a46cd 778 }
Davidroid 0:2887415a46cd 779
Davidroid 7:f7e0c3621f77 780 /**
Davidroid 7:f7e0c3621f77 781 * @brief Disabling interrupts.
Davidroid 7:f7e0c3621f77 782 * @param None.
Davidroid 7:f7e0c3621f77 783 * @retval None.
Davidroid 0:2887415a46cd 784 */
Davidroid 0:2887415a46cd 785 void L6474_DisableIrq(void)
Davidroid 0:2887415a46cd 786 {
Davidroid 0:2887415a46cd 787 __disable_irq();
Davidroid 0:2887415a46cd 788 }
Davidroid 0:2887415a46cd 789
Davidroid 7:f7e0c3621f77 790 /**
Davidroid 7:f7e0c3621f77 791 * @brief Setting the frequency of PWM.
Davidroid 7:f7e0c3621f77 792 * The frequency controls directly the speed of the device.
Davidroid 7:f7e0c3621f77 793 * @param newFreq the frequency of PWM.
Davidroid 7:f7e0c3621f77 794 * @retval None.
Davidroid 0:2887415a46cd 795 */
Davidroid 0:2887415a46cd 796 void L6474_PwmSetFreq(uint16_t newFreq)
Davidroid 0:2887415a46cd 797 {
Davidroid 0:2887415a46cd 798 double period = 1.0f / newFreq;
Davidroid 0:2887415a46cd 799 pwm.period(period);
Davidroid 0:2887415a46cd 800 pwm.write(0.5f);
Davidroid 1:b38ebb8ea286 801 ticker.attach(this, &L6474::L6474_StepClockHandler, period);
Davidroid 0:2887415a46cd 802 }
Davidroid 0:2887415a46cd 803
Davidroid 7:f7e0c3621f77 804 /**
Davidroid 7:f7e0c3621f77 805 * @brief Initialising the PWM.
Davidroid 7:f7e0c3621f77 806 * @param None.
Davidroid 7:f7e0c3621f77 807 * @retval None.
Davidroid 0:2887415a46cd 808 */
Davidroid 7:f7e0c3621f77 809 void L6474_PwmInit(void) {}
Davidroid 0:2887415a46cd 810
Davidroid 7:f7e0c3621f77 811 /**
Davidroid 7:f7e0c3621f77 812 * @brief Stopping the PWM.
Davidroid 7:f7e0c3621f77 813 * @param None.
Davidroid 7:f7e0c3621f77 814 * @retval None.
Davidroid 0:2887415a46cd 815 */
Davidroid 0:2887415a46cd 816 void L6474_PwmStop(void)
Davidroid 0:2887415a46cd 817 {
Davidroid 0:2887415a46cd 818 pwm.write(0.0f);
Davidroid 0:2887415a46cd 819 ticker.detach();
Davidroid 0:2887415a46cd 820 }
Davidroid 0:2887415a46cd 821
Davidroid 7:f7e0c3621f77 822 /**
Davidroid 7:f7e0c3621f77 823 * @brief Putting the device in standby mode.
Davidroid 7:f7e0c3621f77 824 * @param None.
Davidroid 7:f7e0c3621f77 825 * @retval None.
Davidroid 0:2887415a46cd 826 */
Davidroid 0:2887415a46cd 827 void L6474_ReleaseReset(void)
Davidroid 0:2887415a46cd 828 {
Davidroid 4:83a1eb397a65 829 standby_reset = 1;
Davidroid 0:2887415a46cd 830 }
Davidroid 0:2887415a46cd 831
Davidroid 7:f7e0c3621f77 832 /**
Davidroid 7:f7e0c3621f77 833 * @brief Putting the device in reset mode.
Davidroid 7:f7e0c3621f77 834 * @param None.
Davidroid 7:f7e0c3621f77 835 * @retval None.
Davidroid 0:2887415a46cd 836 */
Davidroid 0:2887415a46cd 837 void L6474_Reset(void)
Davidroid 0:2887415a46cd 838 {
Davidroid 4:83a1eb397a65 839 standby_reset = 0;
Davidroid 0:2887415a46cd 840 }
Davidroid 0:2887415a46cd 841
Davidroid 7:f7e0c3621f77 842 /**
Davidroid 7:f7e0c3621f77 843 * @brief Setting the direction of rotation.
Davidroid 7:f7e0c3621f77 844 * @param gpioState direction of rotation: "1" for forward, "0" for backward.
Davidroid 7:f7e0c3621f77 845 * @retval None.
Davidroid 0:2887415a46cd 846 */
Davidroid 0:2887415a46cd 847 void L6474_SetDirectionGpio(uint8_t gpioState)
Davidroid 0:2887415a46cd 848 {
Davidroid 0:2887415a46cd 849 direction = gpioState;
Davidroid 0:2887415a46cd 850 }
Davidroid 0:2887415a46cd 851
Davidroid 7:f7e0c3621f77 852 /**
Davidroid 7:f7e0c3621f77 853 * @brief Writing and reading bytes to/from the component through the SPI at the same time.
Davidroid 7:f7e0c3621f77 854 * @param[in] pByteToTransmit pointer to the buffer of data to send.
Davidroid 7:f7e0c3621f77 855 * @param[out] pReceivedByte pointer to the buffer to read data into.
Davidroid 7:f7e0c3621f77 856 * @retval "0" in case of success, "1" otherwise.
Davidroid 0:2887415a46cd 857 */
Davidroid 0:2887415a46cd 858 uint8_t L6474_SpiWriteBytes(uint8_t *pByteToTransmit, uint8_t *pReceivedByte)
Davidroid 0:2887415a46cd 859 {
Davidroid 7:f7e0c3621f77 860 return (uint8_t) (ReadWrite(pReceivedByte, pByteToTransmit, numberOfDevices) == COMPONENT_OK ? 0 : 1);
Davidroid 0:2887415a46cd 861 }
Davidroid 0:2887415a46cd 862
Davidroid 0:2887415a46cd 863
Davidroid 0:2887415a46cd 864 /*** Component's Instance Variables ***/
Davidroid 0:2887415a46cd 865
Davidroid 0:2887415a46cd 866 /* ACTION 9 --------------------------------------------------------------*
Davidroid 10:c3824af0caf4 867 * Declare here interrupt related variables, if needed. *
Davidroid 10:c3824af0caf4 868 * Note that interrupt handling is platform dependent, see *
Davidroid 10:c3824af0caf4 869 * "Interrupt Related Methods" above. *
Davidroid 10:c3824af0caf4 870 * *
Davidroid 10:c3824af0caf4 871 * Example: *
Davidroid 10:c3824af0caf4 872 * + mbed: *
Davidroid 10:c3824af0caf4 873 * InterruptIn feature_irq; *
Davidroid 0:2887415a46cd 874 *------------------------------------------------------------------------*/
Davidroid 7:f7e0c3621f77 875 /* Flag Interrupt. */
Davidroid 7:f7e0c3621f77 876 InterruptIn flag_irq;
Davidroid 10:c3824af0caf4 877
Davidroid 10:c3824af0caf4 878 /* ACTION 10 -------------------------------------------------------------*
Davidroid 10:c3824af0caf4 879 * Declare here other pin related variables, if needed. *
Davidroid 10:c3824af0caf4 880 * *
Davidroid 10:c3824af0caf4 881 * Example: *
Davidroid 10:c3824af0caf4 882 * + mbed: *
Davidroid 10:c3824af0caf4 883 * DigitalOut standby_reset; *
Davidroid 10:c3824af0caf4 884 *------------------------------------------------------------------------*/
Davidroid 4:83a1eb397a65 885 /* Standby/reset pin. */
Davidroid 4:83a1eb397a65 886 DigitalOut standby_reset;
Davidroid 0:2887415a46cd 887
Davidroid 0:2887415a46cd 888 /* Direction of rotation pin. */
Davidroid 0:2887415a46cd 889 DigitalOut direction;
Davidroid 0:2887415a46cd 890
Davidroid 0:2887415a46cd 891 /* Pulse Width Modulation pin. */
Davidroid 0:2887415a46cd 892 PwmOut pwm;
Davidroid 0:2887415a46cd 893
Davidroid 10:c3824af0caf4 894 /* Timer to trigger the PWM callback at each PWM pulse. */
Davidroid 10:c3824af0caf4 895 Ticker ticker;
Davidroid 10:c3824af0caf4 896
Davidroid 10:c3824af0caf4 897 /* ACTION 11 -------------------------------------------------------------*
Davidroid 10:c3824af0caf4 898 * Declare here communication related variables, if needed. *
Davidroid 10:c3824af0caf4 899 * *
Davidroid 10:c3824af0caf4 900 * Example: *
Davidroid 10:c3824af0caf4 901 * + mbed: *
Davidroid 10:c3824af0caf4 902 * DigitalOut ssel; *
Davidroid 10:c3824af0caf4 903 * DevSPI &dev_spi; *
Davidroid 10:c3824af0caf4 904 *------------------------------------------------------------------------*/
Davidroid 4:83a1eb397a65 905 /* Configuration. */
Davidroid 4:83a1eb397a65 906 DigitalOut ssel;
Davidroid 0:2887415a46cd 907
Davidroid 0:2887415a46cd 908 /* IO Device. */
Davidroid 0:2887415a46cd 909 DevSPI &dev_spi;
Davidroid 0:2887415a46cd 910
Davidroid 10:c3824af0caf4 911 /* ACTION 12 -------------------------------------------------------------*
Davidroid 10:c3824af0caf4 912 * Declare here identity related variables, if needed. *
Davidroid 10:c3824af0caf4 913 * Note that there should be only a unique identifier for each component, *
Davidroid 10:c3824af0caf4 914 * which should be the "who_am_i" parameter. *
Davidroid 10:c3824af0caf4 915 *------------------------------------------------------------------------*/
Davidroid 10:c3824af0caf4 916 /* Identity */
Davidroid 10:c3824af0caf4 917 uint8_t who_am_i;
Davidroid 4:83a1eb397a65 918
Davidroid 10:c3824af0caf4 919 /* ACTION 13 -------------------------------------------------------------*
Davidroid 10:c3824af0caf4 920 * Declare here the component's static and non-static data, one variable *
Davidroid 10:c3824af0caf4 921 * per line. *
Davidroid 0:2887415a46cd 922 * *
Davidroid 0:2887415a46cd 923 * Example: *
Davidroid 10:c3824af0caf4 924 * float measure; *
Davidroid 10:c3824af0caf4 925 * int instance_id; *
Davidroid 10:c3824af0caf4 926 * static int number_of_instances; *
Davidroid 0:2887415a46cd 927 *------------------------------------------------------------------------*/
Davidroid 0:2887415a46cd 928 /* Data. */
Davidroid 0:2887415a46cd 929 void (*errorHandlerCallback)(uint16_t error);
Davidroid 0:2887415a46cd 930 deviceParams_t devicePrm;
Davidroid 5:d3c78f12a78d 931 uint8_t deviceInstance;
Davidroid 7:f7e0c3621f77 932
Davidroid 7:f7e0c3621f77 933 /* Static data. */
Davidroid 0:2887415a46cd 934 static uint8_t numberOfDevices;
Davidroid 7:f7e0c3621f77 935 static uint8_t spiTxBursts[L6474_CMD_ARG_MAX_NB_BYTES][MAX_NUMBER_OF_DEVICES];
Davidroid 7:f7e0c3621f77 936 static uint8_t spiRxBursts[L6474_CMD_ARG_MAX_NB_BYTES][MAX_NUMBER_OF_DEVICES];
Davidroid 7:f7e0c3621f77 937
Davidroid 7:f7e0c3621f77 938
Davidroid 7:f7e0c3621f77 939 public:
Davidroid 7:f7e0c3621f77 940
Davidroid 7:f7e0c3621f77 941 /* Static data. */
Davidroid 6:a47569fc7534 942 static bool spiPreemtionByIsr;
Davidroid 6:a47569fc7534 943 static bool isrFlag;
Davidroid 0:2887415a46cd 944 };
Davidroid 0:2887415a46cd 945
Davidroid 0:2887415a46cd 946 #endif // __L6474_CLASS_H
Davidroid 0:2887415a46cd 947
Davidroid 0:2887415a46cd 948 /************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/