test

Fork of CANnucleo by Zoltan Hudak

Committer:
hudakz
Date:
Thu May 19 17:16:59 2016 +0000
Revision:
21:bcd8161f8f6c
Parent:
17:1fd35431ee8e
Added support for attaching member functions as interrupt handlers.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
hudakz 0:e29bc8e0dddd 1 /*
hudakz 5:b53e5ee15315 2 ******************************************************************************
hudakz 5:b53e5ee15315 3 * @file can_api.c
hudakz 5:b53e5ee15315 4 * @author Zoltan Hudak
hudakz 5:b53e5ee15315 5 * @version
hudakz 5:b53e5ee15315 6 * @date 04-August-2015
hudakz 5:b53e5ee15315 7 * @brief CAN api for NUCLEO-F103RB platform
hudakz 5:b53e5ee15315 8 ******************************************************************************
hudakz 5:b53e5ee15315 9 * @attention
hudakz 5:b53e5ee15315 10 *
hudakz 5:b53e5ee15315 11 * <h2><center>&copy; COPYRIGHT(c) 2015 Zoltan Hudak <hudakz@inbox.com>
hudakz 5:b53e5ee15315 12 *
hudakz 5:b53e5ee15315 13 * All rights reserved.
hudakz 0:e29bc8e0dddd 14
hudakz 0:e29bc8e0dddd 15 This program is free software: you can redistribute it and/or modify
hudakz 0:e29bc8e0dddd 16 it under the terms of the GNU General Public License as published by
hudakz 0:e29bc8e0dddd 17 the Free Software Foundation, either version 3 of the License, or
hudakz 0:e29bc8e0dddd 18 (at your option) any later version.
hudakz 0:e29bc8e0dddd 19
hudakz 0:e29bc8e0dddd 20 This program is distributed in the hope that it will be useful,
hudakz 0:e29bc8e0dddd 21 but WITHOUT ANY WARRANTY; without even the implied warranty of
hudakz 0:e29bc8e0dddd 22 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
hudakz 0:e29bc8e0dddd 23 GNU General Public License for more details.
hudakz 0:e29bc8e0dddd 24
hudakz 0:e29bc8e0dddd 25 You should have received a copy of the GNU General Public License
hudakz 0:e29bc8e0dddd 26 along with this program. If not, see <http://www.gnu.org/licenses/>.
hudakz 0:e29bc8e0dddd 27 */
hudakz 0:e29bc8e0dddd 28 #include "can_api.h"
hudakz 0:e29bc8e0dddd 29 #include "can_helper.h"
hudakz 0:e29bc8e0dddd 30 #include "pinmap.h"
hudakz 0:e29bc8e0dddd 31
hudakz 21:bcd8161f8f6c 32 extern void (*rxCompleteCallback)(void);
hudakz 21:bcd8161f8f6c 33 extern CAN_HandleTypeDef _canHandle;
hudakz 21:bcd8161f8f6c 34
hudakz 21:bcd8161f8f6c 35 static uint32_t irq_id = 0;
hudakz 21:bcd8161f8f6c 36 static can_irq_handler irq_handler = 0;
hudakz 0:e29bc8e0dddd 37
hudakz 0:e29bc8e0dddd 38 /**
hudakz 0:e29bc8e0dddd 39 * @brief
hudakz 0:e29bc8e0dddd 40 * @note
hudakz 0:e29bc8e0dddd 41 * @param
hudakz 0:e29bc8e0dddd 42 * @retval
hudakz 0:e29bc8e0dddd 43 */
hudakz 21:bcd8161f8f6c 44 void can_init(PinName rd, PinName td, FunctionalState abom) {
hudakz 21:bcd8161f8f6c 45 initCAN(rd, td, abom);
hudakz 21:bcd8161f8f6c 46 can_filter(0, 0, CANAny, 0);
hudakz 0:e29bc8e0dddd 47 }
hudakz 0:e29bc8e0dddd 48
hudakz 0:e29bc8e0dddd 49 /**
hudakz 0:e29bc8e0dddd 50 * @brief
hudakz 0:e29bc8e0dddd 51 * @note
hudakz 0:e29bc8e0dddd 52 * @param
hudakz 0:e29bc8e0dddd 53 * @retval
hudakz 0:e29bc8e0dddd 54 */
hudakz 21:bcd8161f8f6c 55 void can_free(void) {
hudakz 15:5123ead7b002 56 HAL_CAN_MspDeInit(&_canHandle);
hudakz 0:e29bc8e0dddd 57 }
hudakz 0:e29bc8e0dddd 58
hudakz 0:e29bc8e0dddd 59 /**
hudakz 0:e29bc8e0dddd 60 * @brief
hudakz 0:e29bc8e0dddd 61 * @note
hudakz 0:e29bc8e0dddd 62 * @param
hudakz 0:e29bc8e0dddd 63 * @retval
hudakz 0:e29bc8e0dddd 64 */
hudakz 21:bcd8161f8f6c 65 int can_frequency(int hz) {
hudakz 15:5123ead7b002 66 HAL_NVIC_DisableIRQ(CAN_IRQ);
hudakz 16:f4c8f45bded9 67
hudakz 16:f4c8f45bded9 68 #if defined(TARGET_NUCLEO_F072RB) || \
hudakz 16:f4c8f45bded9 69 defined(TARGET_NUCLEO_F091RC)
hudakz 16:f4c8f45bded9 70
hudakz 16:f4c8f45bded9 71 // APB1 peripheral clock = 48000000Hz
hudakz 16:f4c8f45bded9 72
hudakz 16:f4c8f45bded9 73 switch(hz) {
hudakz 16:f4c8f45bded9 74 case 1000000:
hudakz 16:f4c8f45bded9 75 // 1000kbps bit rate
hudakz 16:f4c8f45bded9 76 _canHandle.Init.Prescaler = 4; // number of time quanta = 48000000/4/1000000 = 12
hudakz 16:f4c8f45bded9 77 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 16:f4c8f45bded9 78 _canHandle.Init.BS1 = CAN_BS1_8TQ; // sample point at: (1 + 8) / 12 * 100 = 75%
hudakz 16:f4c8f45bded9 79 _canHandle.Init.BS2 = CAN_BS2_3TQ;
hudakz 16:f4c8f45bded9 80 break;
hudakz 16:f4c8f45bded9 81
hudakz 16:f4c8f45bded9 82 case 500000:
hudakz 16:f4c8f45bded9 83 // 500kbps bit rate
hudakz 16:f4c8f45bded9 84 _canHandle.Init.Prescaler = 8; // number of time quanta = 48000000/8/500000 = 12
hudakz 16:f4c8f45bded9 85 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 16:f4c8f45bded9 86 _canHandle.Init.BS1 = CAN_BS1_8TQ; // sample point at: (1 + 8) / 12 * 100 = 75%
hudakz 16:f4c8f45bded9 87 _canHandle.Init.BS2 = CAN_BS2_3TQ;
hudakz 16:f4c8f45bded9 88 break;
hudakz 16:f4c8f45bded9 89
hudakz 16:f4c8f45bded9 90 case 250000:
hudakz 16:f4c8f45bded9 91 // 250kbps
hudakz 16:f4c8f45bded9 92 _canHandle.Init.Prescaler = 12; // number of time quanta = 48000000/12/250000 = 16
hudakz 16:f4c8f45bded9 93 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 16:f4c8f45bded9 94 _canHandle.Init.BS1 = CAN_BS1_11TQ; // sample point at: (1 + 11) / 16 * 100 = 75%
hudakz 16:f4c8f45bded9 95 _canHandle.Init.BS2 = CAN_BS2_4TQ;
hudakz 16:f4c8f45bded9 96 break;
hudakz 16:f4c8f45bded9 97
hudakz 16:f4c8f45bded9 98 case 125000:
hudakz 16:f4c8f45bded9 99 // 125kbps
hudakz 16:f4c8f45bded9 100 _canHandle.Init.Prescaler = 24; // number of time quanta = 48000000/24/125000 = 16
hudakz 16:f4c8f45bded9 101 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 16:f4c8f45bded9 102 _canHandle.Init.BS1 = CAN_BS1_11TQ; // sample point at: (1 + 11) / 16 * 100 = 75%
hudakz 16:f4c8f45bded9 103 _canHandle.Init.BS2 = CAN_BS2_4TQ;
hudakz 16:f4c8f45bded9 104 break;
hudakz 16:f4c8f45bded9 105
hudakz 16:f4c8f45bded9 106 default:
hudakz 16:f4c8f45bded9 107 // 125kbps (default)
hudakz 16:f4c8f45bded9 108 _canHandle.Init.Prescaler = 24; // number of time quanta = 48000000/24/125000 = 16
hudakz 16:f4c8f45bded9 109 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 16:f4c8f45bded9 110 _canHandle.Init.BS1 = CAN_BS1_11TQ; // sample point at: (1 + 11) / 16 * 100 = 75%
hudakz 16:f4c8f45bded9 111 _canHandle.Init.BS2 = CAN_BS2_4TQ;
hudakz 16:f4c8f45bded9 112 }
hudakz 0:e29bc8e0dddd 113
hudakz 16:f4c8f45bded9 114 #elif defined(TARGET_NUCLEO_F103RB) || \
hudakz 16:f4c8f45bded9 115 defined(TARGET_NUCLEO_F303RE) || \
hudakz 16:f4c8f45bded9 116 defined(TARGET_NUCLEO_F303K8) || \
hudakz 16:f4c8f45bded9 117 defined(TARGET_NUCLEO_F334R8) || \
hudakz 16:f4c8f45bded9 118 defined(TARGET_DISCO_F334C8)
hudakz 16:f4c8f45bded9 119
hudakz 5:b53e5ee15315 120 // APB1 peripheral clock = 36000000Hz
hudakz 0:e29bc8e0dddd 121
hudakz 0:e29bc8e0dddd 122 switch(hz) {
hudakz 0:e29bc8e0dddd 123 case 1000000:
hudakz 0:e29bc8e0dddd 124 // 1000kbps bit rate
hudakz 0:e29bc8e0dddd 125 _canHandle.Init.Prescaler = 3; // number of time quanta = 36000000/3/1000000 = 12
hudakz 0:e29bc8e0dddd 126 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 0:e29bc8e0dddd 127 _canHandle.Init.BS1 = CAN_BS1_8TQ; // sample point at: (1 + 8) / 12 * 100 = 75%
hudakz 0:e29bc8e0dddd 128 _canHandle.Init.BS2 = CAN_BS2_3TQ;
hudakz 0:e29bc8e0dddd 129 break;
hudakz 0:e29bc8e0dddd 130
hudakz 0:e29bc8e0dddd 131 case 500000:
hudakz 0:e29bc8e0dddd 132 // 500kbps bit rate
hudakz 0:e29bc8e0dddd 133 _canHandle.Init.Prescaler = 6; // number of time quanta = 36000000/6/500000 = 12
hudakz 0:e29bc8e0dddd 134 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 0:e29bc8e0dddd 135 _canHandle.Init.BS1 = CAN_BS1_8TQ; // sample point at: (1 + 8) / 12 * 100 = 75%
hudakz 0:e29bc8e0dddd 136 _canHandle.Init.BS2 = CAN_BS2_3TQ;
hudakz 0:e29bc8e0dddd 137 break;
hudakz 0:e29bc8e0dddd 138
hudakz 0:e29bc8e0dddd 139 case 250000:
hudakz 0:e29bc8e0dddd 140 // 250kbps
hudakz 0:e29bc8e0dddd 141 _canHandle.Init.Prescaler = 9; // number of time quanta = 36000000/9/250000 = 16
hudakz 0:e29bc8e0dddd 142 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 0:e29bc8e0dddd 143 _canHandle.Init.BS1 = CAN_BS1_11TQ; // sample point at: (1 + 11) / 16 * 100 = 75%
hudakz 0:e29bc8e0dddd 144 _canHandle.Init.BS2 = CAN_BS2_4TQ;
hudakz 0:e29bc8e0dddd 145 break;
hudakz 0:e29bc8e0dddd 146
hudakz 0:e29bc8e0dddd 147 case 125000:
hudakz 0:e29bc8e0dddd 148 // 125kbps
hudakz 0:e29bc8e0dddd 149 _canHandle.Init.Prescaler = 18; // number of time quanta = 36000000/18/125000 = 16
hudakz 0:e29bc8e0dddd 150 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 0:e29bc8e0dddd 151 _canHandle.Init.BS1 = CAN_BS1_11TQ; // sample point at: (1 + 11) / 16 * 100 = 75%
hudakz 0:e29bc8e0dddd 152 _canHandle.Init.BS2 = CAN_BS2_4TQ;
hudakz 0:e29bc8e0dddd 153 break;
hudakz 0:e29bc8e0dddd 154
hudakz 0:e29bc8e0dddd 155 default:
hudakz 0:e29bc8e0dddd 156 // 125kbps (default)
hudakz 5:b53e5ee15315 157 #if DEBUG
hudakz 0:e29bc8e0dddd 158 printf("Unknown frequency specified!\r\n");
hudakz 0:e29bc8e0dddd 159 printf("Using default 125kbps\r\n");
hudakz 5:b53e5ee15315 160 #endif
hudakz 17:1fd35431ee8e 161 _canHandle.Init.Prescaler = 18; // number of time quanta = 36000000/18/125000 = 16
hudakz 16:f4c8f45bded9 162 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 17:1fd35431ee8e 163 _canHandle.Init.BS1 = CAN_BS1_11TQ; // sample point at: (1 + 11) / 16 * 100 = 75%
hudakz 16:f4c8f45bded9 164 _canHandle.Init.BS2 = CAN_BS2_4TQ;
hudakz 16:f4c8f45bded9 165 }
hudakz 16:f4c8f45bded9 166
hudakz 16:f4c8f45bded9 167 #elif defined(TARGET_NUCLEO_F446RE)
hudakz 16:f4c8f45bded9 168
hudakz 16:f4c8f45bded9 169 // APB1 peripheral clock = 45000000Hz
hudakz 16:f4c8f45bded9 170
hudakz 16:f4c8f45bded9 171 switch(hz) {
hudakz 16:f4c8f45bded9 172 case 1000000:
hudakz 16:f4c8f45bded9 173 // 1000kbps bit rate
hudakz 16:f4c8f45bded9 174 _canHandle.Init.Prescaler = 5; // number of time quanta = 45000000/5/1000000 = 9
hudakz 16:f4c8f45bded9 175 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 16:f4c8f45bded9 176 _canHandle.Init.BS1 = CAN_BS1_6TQ; // sample point at: (1 + 6) / 9 * 100 = 77.78%
hudakz 16:f4c8f45bded9 177 _canHandle.Init.BS2 = CAN_BS2_2TQ;
hudakz 16:f4c8f45bded9 178 break;
hudakz 16:f4c8f45bded9 179
hudakz 16:f4c8f45bded9 180 case 500000:
hudakz 16:f4c8f45bded9 181 // 500kbps bit rate
hudakz 16:f4c8f45bded9 182 _canHandle.Init.Prescaler = 10; // number of time quanta = 45000000/10/500000 = 9
hudakz 16:f4c8f45bded9 183 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 16:f4c8f45bded9 184 _canHandle.Init.BS1 = CAN_BS1_6TQ; // sample point at: (1 + 6) / 9 * 100 = 77.78%
hudakz 16:f4c8f45bded9 185 _canHandle.Init.BS2 = CAN_BS2_2TQ;
hudakz 16:f4c8f45bded9 186 break;
hudakz 16:f4c8f45bded9 187
hudakz 16:f4c8f45bded9 188 case 250000:
hudakz 16:f4c8f45bded9 189 // 250kbps
hudakz 16:f4c8f45bded9 190 _canHandle.Init.Prescaler = 15; // number of time quanta = 45000000/15/250000 = 12
hudakz 16:f4c8f45bded9 191 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 16:f4c8f45bded9 192 _canHandle.Init.BS1 = CAN_BS1_8TQ; // sample point at: (1 + 8) / 12 * 100 = 75%
hudakz 16:f4c8f45bded9 193 _canHandle.Init.BS2 = CAN_BS2_3TQ;
hudakz 16:f4c8f45bded9 194 break;
hudakz 16:f4c8f45bded9 195
hudakz 16:f4c8f45bded9 196 case 125000:
hudakz 16:f4c8f45bded9 197 // 125kbps
hudakz 16:f4c8f45bded9 198 _canHandle.Init.Prescaler = 30; // number of time quanta = 45000000/30/125000 = 12
hudakz 16:f4c8f45bded9 199 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 16:f4c8f45bded9 200 _canHandle.Init.BS1 = CAN_BS1_8TQ; // sample point at: (1 + 8) / 12 * 100 = 75%
hudakz 16:f4c8f45bded9 201 _canHandle.Init.BS2 = CAN_BS2_3TQ;
hudakz 16:f4c8f45bded9 202 break;
hudakz 16:f4c8f45bded9 203
hudakz 16:f4c8f45bded9 204 default:
hudakz 16:f4c8f45bded9 205 // 125kbps (default)
hudakz 16:f4c8f45bded9 206 #if DEBUG
hudakz 16:f4c8f45bded9 207 printf("Unknown frequency specified!\r\n");
hudakz 16:f4c8f45bded9 208 printf("Using default 125kbps\r\n");
hudakz 16:f4c8f45bded9 209 #endif
hudakz 17:1fd35431ee8e 210 _canHandle.Init.Prescaler = 30; // number of time quanta = 45000000/30/125000 = 12
hudakz 0:e29bc8e0dddd 211 _canHandle.Init.SJW = CAN_SJW_1TQ;
hudakz 17:1fd35431ee8e 212 _canHandle.Init.BS1 = CAN_BS1_8TQ; // sample point at: (1 + 8) / 12 * 100 = 75%
hudakz 17:1fd35431ee8e 213 _canHandle.Init.BS2 = CAN_BS2_3TQ;
hudakz 0:e29bc8e0dddd 214 }
hudakz 16:f4c8f45bded9 215
hudakz 16:f4c8f45bded9 216 #endif
hudakz 0:e29bc8e0dddd 217
hudakz 0:e29bc8e0dddd 218 HAL_CAN_Init(&_canHandle);
hudakz 15:5123ead7b002 219 HAL_NVIC_EnableIRQ(CAN_IRQ);
hudakz 11:439f3a34c42e 220
hudakz 5:b53e5ee15315 221 return 1;
hudakz 0:e29bc8e0dddd 222 }
hudakz 0:e29bc8e0dddd 223
hudakz 0:e29bc8e0dddd 224 /**
hudakz 0:e29bc8e0dddd 225 * @brief
hudakz 0:e29bc8e0dddd 226 * @note
hudakz 0:e29bc8e0dddd 227 * @param
hudakz 0:e29bc8e0dddd 228 * @retval
hudakz 0:e29bc8e0dddd 229 */
hudakz 21:bcd8161f8f6c 230 void can_callback(void) {
hudakz 21:bcd8161f8f6c 231 irq_handler(irq_id, IRQ_RX);
hudakz 21:bcd8161f8f6c 232 }
hudakz 21:bcd8161f8f6c 233
hudakz 21:bcd8161f8f6c 234 /**
hudakz 21:bcd8161f8f6c 235 * @brief
hudakz 21:bcd8161f8f6c 236 * @note
hudakz 21:bcd8161f8f6c 237 * @param
hudakz 21:bcd8161f8f6c 238 * @retval
hudakz 21:bcd8161f8f6c 239 */
hudakz 21:bcd8161f8f6c 240 void can_irq_init(uint32_t id, can_irq_handler handler) {
hudakz 21:bcd8161f8f6c 241 irq_id = id;
hudakz 21:bcd8161f8f6c 242 irq_handler = handler;
hudakz 21:bcd8161f8f6c 243 rxCompleteCallback = can_callback;
hudakz 21:bcd8161f8f6c 244
hudakz 0:e29bc8e0dddd 245 if(HAL_CAN_Receive_IT(&_canHandle, CAN_FIFO0) != HAL_OK) {
hudakz 5:b53e5ee15315 246 #ifdef DEBUG
hudakz 0:e29bc8e0dddd 247 printf("CAN reception initialization error\r\n");
hudakz 5:b53e5ee15315 248 #endif
hudakz 0:e29bc8e0dddd 249 }
hudakz 0:e29bc8e0dddd 250 }
hudakz 0:e29bc8e0dddd 251
hudakz 0:e29bc8e0dddd 252 /**
hudakz 0:e29bc8e0dddd 253 * @brief
hudakz 0:e29bc8e0dddd 254 * @note
hudakz 0:e29bc8e0dddd 255 * @param
hudakz 0:e29bc8e0dddd 256 * @retval
hudakz 0:e29bc8e0dddd 257 */
hudakz 21:bcd8161f8f6c 258 void can_irq_free(void) {
hudakz 11:439f3a34c42e 259 rxCompleteCallback = 0;
hudakz 21:bcd8161f8f6c 260 }
hudakz 0:e29bc8e0dddd 261
hudakz 0:e29bc8e0dddd 262 /**
hudakz 0:e29bc8e0dddd 263 * @brief
hudakz 0:e29bc8e0dddd 264 * @note
hudakz 0:e29bc8e0dddd 265 * @param
hudakz 0:e29bc8e0dddd 266 * @retval
hudakz 0:e29bc8e0dddd 267 */
hudakz 21:bcd8161f8f6c 268 int can_write(CAN_Message msg, int cc) {
hudakz 0:e29bc8e0dddd 269 int i = 0;
hudakz 0:e29bc8e0dddd 270
hudakz 0:e29bc8e0dddd 271 if(msg.format == CANStandard) {
hudakz 0:e29bc8e0dddd 272 _canHandle.pTxMsg->StdId = msg.id;
hudakz 0:e29bc8e0dddd 273 _canHandle.pTxMsg->ExtId = 0x00;
hudakz 0:e29bc8e0dddd 274 }
hudakz 0:e29bc8e0dddd 275 else {
hudakz 0:e29bc8e0dddd 276 _canHandle.pTxMsg->StdId = 0x00;
hudakz 0:e29bc8e0dddd 277 _canHandle.pTxMsg->ExtId = msg.id;
hudakz 0:e29bc8e0dddd 278 }
hudakz 0:e29bc8e0dddd 279
hudakz 0:e29bc8e0dddd 280 _canHandle.pTxMsg->RTR = msg.type == CANData ? CAN_RTR_DATA : CAN_RTR_REMOTE;
hudakz 0:e29bc8e0dddd 281 _canHandle.pTxMsg->IDE = msg.format == CANStandard ? CAN_ID_STD : CAN_ID_EXT;
hudakz 0:e29bc8e0dddd 282 _canHandle.pTxMsg->DLC = msg.len;
hudakz 0:e29bc8e0dddd 283
hudakz 0:e29bc8e0dddd 284 for(i = 0; i < msg.len; i++)
hudakz 0:e29bc8e0dddd 285 _canHandle.pTxMsg->Data[i] = msg.data[i];
hudakz 0:e29bc8e0dddd 286
hudakz 0:e29bc8e0dddd 287 if(HAL_CAN_Transmit(&_canHandle, 10) != HAL_OK) {
hudakz 5:b53e5ee15315 288 #ifdef DEBUG
hudakz 0:e29bc8e0dddd 289 printf("Transmission error\r\n");
hudakz 5:b53e5ee15315 290 #endif
hudakz 5:b53e5ee15315 291 return 0;
hudakz 0:e29bc8e0dddd 292 }
hudakz 5:b53e5ee15315 293 else
hudakz 5:b53e5ee15315 294 return 1;
hudakz 0:e29bc8e0dddd 295 }
hudakz 0:e29bc8e0dddd 296
hudakz 0:e29bc8e0dddd 297 /**
hudakz 0:e29bc8e0dddd 298 * @brief
hudakz 0:e29bc8e0dddd 299 * @note
hudakz 0:e29bc8e0dddd 300 * @param
hudakz 0:e29bc8e0dddd 301 * @retval
hudakz 0:e29bc8e0dddd 302 */
hudakz 21:bcd8161f8f6c 303 int can_read(CAN_Message* msg, int handle) {
hudakz 10:227a455d0f9f 304 int i;
hudakz 0:e29bc8e0dddd 305 msg->id = _canHandle.pRxMsg->IDE == CAN_ID_STD ? _canHandle.pRxMsg->StdId : _canHandle.pRxMsg->ExtId;
hudakz 0:e29bc8e0dddd 306 msg->type = _canHandle.pRxMsg->RTR == CAN_RTR_DATA ? CANData : CANRemote;
hudakz 0:e29bc8e0dddd 307 msg->format = _canHandle.pRxMsg->IDE == CAN_ID_STD ? CANStandard : CANExtended;
hudakz 0:e29bc8e0dddd 308 msg->len = _canHandle.pRxMsg->DLC;
hudakz 10:227a455d0f9f 309 for(i = 0; i < msg->len; i++)
hudakz 0:e29bc8e0dddd 310 msg->data[i] = _canHandle.pRxMsg->Data[i];
hudakz 5:b53e5ee15315 311
hudakz 5:b53e5ee15315 312 return msg->len;
hudakz 0:e29bc8e0dddd 313 }
hudakz 0:e29bc8e0dddd 314
hudakz 0:e29bc8e0dddd 315 /**
hudakz 0:e29bc8e0dddd 316 * @brief
hudakz 0:e29bc8e0dddd 317 * @note
hudakz 0:e29bc8e0dddd 318 * @param
hudakz 0:e29bc8e0dddd 319 * @retval
hudakz 0:e29bc8e0dddd 320 */
hudakz 21:bcd8161f8f6c 321 int can_mode(CanMode mode) {
hudakz 0:e29bc8e0dddd 322 switch(mode) {
hudakz 0:e29bc8e0dddd 323 case MODE_RESET:
hudakz 0:e29bc8e0dddd 324 return HAL_ERROR;
hudakz 0:e29bc8e0dddd 325
hudakz 0:e29bc8e0dddd 326 case MODE_NORMAL:
hudakz 0:e29bc8e0dddd 327 _canHandle.Init.Mode = CAN_MODE_NORMAL;
hudakz 0:e29bc8e0dddd 328 break;
hudakz 0:e29bc8e0dddd 329
hudakz 0:e29bc8e0dddd 330 case MODE_SILENT:
hudakz 0:e29bc8e0dddd 331 _canHandle.Init.Mode = CAN_MODE_SILENT;
hudakz 0:e29bc8e0dddd 332 break;
hudakz 0:e29bc8e0dddd 333
hudakz 0:e29bc8e0dddd 334 case MODE_TEST_GLOBAL:
hudakz 0:e29bc8e0dddd 335 _canHandle.Init.Mode = CAN_MODE_LOOPBACK;
hudakz 0:e29bc8e0dddd 336 break;
hudakz 0:e29bc8e0dddd 337
hudakz 0:e29bc8e0dddd 338 case MODE_TEST_LOCAL:
hudakz 0:e29bc8e0dddd 339 _canHandle.Init.Mode = CAN_MODE_LOOPBACK;
hudakz 0:e29bc8e0dddd 340 break;
hudakz 0:e29bc8e0dddd 341
hudakz 0:e29bc8e0dddd 342 case MODE_TEST_SILENT:
hudakz 0:e29bc8e0dddd 343 _canHandle.Init.Mode = CAN_MODE_SILENT_LOOPBACK;
hudakz 0:e29bc8e0dddd 344 break;
hudakz 0:e29bc8e0dddd 345 }
hudakz 0:e29bc8e0dddd 346
hudakz 3:0fae6b54a2ee 347 return HAL_CAN_Init(&_canHandle);
hudakz 0:e29bc8e0dddd 348 }
hudakz 0:e29bc8e0dddd 349
hudakz 0:e29bc8e0dddd 350 /**
hudakz 0:e29bc8e0dddd 351 * @brief
hudakz 0:e29bc8e0dddd 352 * @note
hudakz 0:e29bc8e0dddd 353 * @param
hudakz 0:e29bc8e0dddd 354 * @retval
hudakz 0:e29bc8e0dddd 355 */
hudakz 21:bcd8161f8f6c 356 int can_filter(uint32_t id, uint32_t mask, CANFormat format /*=CANAny*/, int32_t handle /*=0*/ ) {
hudakz 0:e29bc8e0dddd 357 CAN_FilterConfTypeDef sFilterConfig;
hudakz 0:e29bc8e0dddd 358
hudakz 8:5c90d6b9a382 359 sFilterConfig.FilterNumber = handle; // Specifies the filter number (must be a number between 0 and 13 at 32-bit filter scale)
hudakz 0:e29bc8e0dddd 360 sFilterConfig.FilterMode = CAN_FILTERMODE_IDMASK;
hudakz 0:e29bc8e0dddd 361 sFilterConfig.FilterScale = CAN_FILTERSCALE_32BIT;
hudakz 0:e29bc8e0dddd 362 sFilterConfig.FilterIdHigh = (((id) >> 16) & 0xFFFF);
hudakz 0:e29bc8e0dddd 363 sFilterConfig.FilterIdLow = ((id) & 0xFFFF);
hudakz 0:e29bc8e0dddd 364 sFilterConfig.FilterMaskIdHigh = (((mask) >> 16) & 0xFFFF);
hudakz 0:e29bc8e0dddd 365 sFilterConfig.FilterMaskIdLow = ((mask) & 0xFFFF);
hudakz 0:e29bc8e0dddd 366 sFilterConfig.FilterFIFOAssignment = 0;
hudakz 0:e29bc8e0dddd 367 sFilterConfig.FilterActivation = ENABLE;
hudakz 8:5c90d6b9a382 368 sFilterConfig.BankNumber = 0; // Selects the start bank filter
hudakz 8:5c90d6b9a382 369 return HAL_CAN_ConfigFilter(&_canHandle, &sFilterConfig);
hudakz 0:e29bc8e0dddd 370 }
hudakz 0:e29bc8e0dddd 371
hudakz 0:e29bc8e0dddd 372 /**
hudakz 0:e29bc8e0dddd 373 * @brief
hudakz 0:e29bc8e0dddd 374 * @note
hudakz 0:e29bc8e0dddd 375 * @param
hudakz 0:e29bc8e0dddd 376 * @retval
hudakz 0:e29bc8e0dddd 377 */
hudakz 21:bcd8161f8f6c 378 void can_reset(void) {
hudakz 0:e29bc8e0dddd 379 __HAL_CAN_RESET_HANDLE_STATE(&_canHandle);
hudakz 0:e29bc8e0dddd 380 }
hudakz 0:e29bc8e0dddd 381
hudakz 0:e29bc8e0dddd 382 /**
hudakz 0:e29bc8e0dddd 383 * @brief
hudakz 0:e29bc8e0dddd 384 * @note
hudakz 0:e29bc8e0dddd 385 * @param
hudakz 0:e29bc8e0dddd 386 * @retval
hudakz 0:e29bc8e0dddd 387 */
hudakz 21:bcd8161f8f6c 388 unsigned char can_rderror(void) {
hudakz 0:e29bc8e0dddd 389 return HAL_CAN_GetError(&_canHandle);
hudakz 0:e29bc8e0dddd 390 }
hudakz 0:e29bc8e0dddd 391
hudakz 0:e29bc8e0dddd 392 /**
hudakz 0:e29bc8e0dddd 393 * @brief
hudakz 0:e29bc8e0dddd 394 * @note
hudakz 0:e29bc8e0dddd 395 * @param
hudakz 0:e29bc8e0dddd 396 * @retval
hudakz 0:e29bc8e0dddd 397 */
hudakz 21:bcd8161f8f6c 398 unsigned char can_tderror(void) {
hudakz 0:e29bc8e0dddd 399 return HAL_CAN_GetError(&_canHandle);
hudakz 0:e29bc8e0dddd 400 }
hudakz 0:e29bc8e0dddd 401
hudakz 0:e29bc8e0dddd 402 /**
hudakz 0:e29bc8e0dddd 403 * @brief
hudakz 0:e29bc8e0dddd 404 * @note
hudakz 0:e29bc8e0dddd 405 * @param
hudakz 0:e29bc8e0dddd 406 * @retval
hudakz 0:e29bc8e0dddd 407 */
hudakz 21:bcd8161f8f6c 408 void can_monitor(int silent) {
hudakz 0:e29bc8e0dddd 409
hudakz 0:e29bc8e0dddd 410 // not implemented
hudakz 0:e29bc8e0dddd 411 }
hudakz 1:eb04f7f0478d 412
hudakz 5:b53e5ee15315 413
hudakz 6:c5a40d5fd9f1 414
hudakz 11:439f3a34c42e 415
hudakz 12:c45310ff2233 416
hudakz 21:bcd8161f8f6c 417