test
Fork of CANnucleo by
can_api.c@21:bcd8161f8f6c, 2016-05-19 (annotated)
- 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?
User | Revision | Line number | New 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>© 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 |