mirror of
https://github.com/micropython/micropython.git
synced 2026-04-30 04:40:13 +02:00
c802a13fb6
JavaScript code lint and formatting with Biome / eslint (push) Has been cancelled
Check code formatting / code-formatting (push) Has been cancelled
Check spelling with codespell / codespell (push) Has been cancelled
Build docs / build (push) Has been cancelled
Check examples / embedding (push) Has been cancelled
Package mpremote / build (push) Has been cancelled
.mpy file format and tools / test (push) Has been cancelled
Build ports metadata / build (push) Has been cancelled
alif port / build_alif (alif_ae3_build) (push) Has been cancelled
cc3200 port / build (push) Has been cancelled
esp32 port / build_idf (esp32_build_c2_c5_c6) (push) Has been cancelled
esp32 port / build_idf (esp32_build_cmod_spiram_s2) (push) Has been cancelled
esp32 port / build_idf (esp32_build_p4) (push) Has been cancelled
esp32 port / build_idf (esp32_build_s3_c3) (push) Has been cancelled
esp8266 port / build (push) Has been cancelled
mimxrt port / build (push) Has been cancelled
nrf port / build (push) Has been cancelled
powerpc port / build (push) Has been cancelled
qemu port / build_and_test_arm (bigendian) (push) Has been cancelled
qemu port / build_and_test_arm (sabrelite) (push) Has been cancelled
qemu port / build_and_test_arm (thumb_hardfp) (push) Has been cancelled
qemu port / build_and_test_arm (thumb_softfp) (push) Has been cancelled
qemu port / build_and_test_rv32 (push) Has been cancelled
qemu port / build_and_test_rv64 (push) Has been cancelled
renesas-ra port / build_renesas_ra_board (push) Has been cancelled
rp2 port / build (push) Has been cancelled
samd port / build (push) Has been cancelled
stm32 port / build_stm32 (stm32_misc_build) (push) Has been cancelled
stm32 port / build_stm32 (stm32_nucleo_build) (push) Has been cancelled
stm32 port / build_stm32 (stm32_pyb_build) (push) Has been cancelled
unix port / minimal (push) Has been cancelled
unix port / reproducible (push) Has been cancelled
unix port / standard (push) Has been cancelled
unix port / standard_v2 (push) Has been cancelled
unix port / coverage (push) Has been cancelled
unix port / coverage_32bit (push) Has been cancelled
unix port / nanbox (push) Has been cancelled
unix port / longlong (push) Has been cancelled
unix port / float (push) Has been cancelled
unix port / gil_enabled (push) Has been cancelled
unix port / stackless_clang (push) Has been cancelled
unix port / float_clang (push) Has been cancelled
unix port / settrace_stackless (push) Has been cancelled
unix port / repr_b (push) Has been cancelled
unix port / macos (push) Has been cancelled
unix port / qemu_mips (push) Has been cancelled
unix port / qemu_arm (push) Has been cancelled
unix port / qemu_riscv64 (push) Has been cancelled
unix port / sanitize_address (push) Has been cancelled
unix port / sanitize_undefined (push) Has been cancelled
webassembly port / build (push) Has been cancelled
windows port / build-vs (Debug, true, x64, dev, 2017, [15, 16)) (push) Has been cancelled
windows port / build-vs (Debug, true, x86, dev, 2017, [15, 16)) (push) Has been cancelled
windows port / build-vs (Debug, x64, dev, 2022, [17, 18)) (push) Has been cancelled
windows port / build-vs (Debug, x86, dev, 2022, [17, 18)) (push) Has been cancelled
windows port / build-vs (Release, true, x64, dev, 2017, [15, 16)) (push) Has been cancelled
windows port / build-vs (Release, true, x64, dev, 2019, [16, 17)) (push) Has been cancelled
windows port / build-vs (Release, true, x64, standard, 2017, [15, 16)) (push) Has been cancelled
windows port / build-vs (Release, true, x64, standard, 2019, [16, 17)) (push) Has been cancelled
windows port / build-vs (Release, true, x86, dev, 2017, [15, 16)) (push) Has been cancelled
windows port / build-vs (Release, true, x86, dev, 2019, [16, 17)) (push) Has been cancelled
windows port / build-vs (Release, true, x86, standard, 2017, [15, 16)) (push) Has been cancelled
windows port / build-vs (Release, true, x86, standard, 2019, [16, 17)) (push) Has been cancelled
windows port / build-vs (Release, x64, dev, 2022, [17, 18)) (push) Has been cancelled
windows port / build-vs (Release, x64, standard, 2022, [17, 18)) (push) Has been cancelled
windows port / build-vs (Release, x86, dev, 2022, [17, 18)) (push) Has been cancelled
windows port / build-vs (Release, x86, standard, 2022, [17, 18)) (push) Has been cancelled
windows port / build-mingw (i686, mingw32, dev) (push) Has been cancelled
windows port / build-mingw (i686, mingw32, standard) (push) Has been cancelled
windows port / build-mingw (x86_64, mingw64, dev) (push) Has been cancelled
windows port / build-mingw (x86_64, mingw64, standard) (push) Has been cancelled
windows port / cross-build-on-linux (push) Has been cancelled
zephyr port / build (push) Has been cancelled
Python code lint and formatting with ruff / ruff (push) Has been cancelled
The DAR register field is for auto-retransmit, FDCAN doesn't support automatic restart to clear Bus Off. This work was funded through GitHub Sponsors. Signed-off-by: Angus Gratton <angus@redyak.com.au>
947 lines
37 KiB
C
947 lines
37 KiB
C
/*
|
|
* This file is part of the MicroPython project, http://micropython.org/
|
|
*
|
|
* The MIT License (MIT)
|
|
*
|
|
* Copyright (c) 2014-2018 Damien P. George
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
* in the Software without restriction, including without limitation the rights
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included in
|
|
* all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
* THE SOFTWARE.
|
|
*/
|
|
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
|
|
#include "py/obj.h"
|
|
#include "py/objarray.h"
|
|
#include "py/runtime.h"
|
|
#include "py/gc.h"
|
|
#include "py/binary.h"
|
|
#include "py/stream.h"
|
|
#include "py/mperrno.h"
|
|
#include "py/mphal.h"
|
|
#include "bufhelper.h"
|
|
#include "pyb_can.h"
|
|
#include "can.h"
|
|
#include "irq.h"
|
|
// For some non-port-specific utility functions
|
|
#include "extmod/machine_can.h"
|
|
|
|
#if MICROPY_HW_ENABLE_CAN
|
|
|
|
#if MICROPY_HW_ENABLE_FDCAN
|
|
|
|
#define CAN_MAX_DATA_FRAME (64)
|
|
|
|
#define CAN_FILTER_FIFO0 (0)
|
|
|
|
// Default timings; 125Kbps
|
|
#if defined(STM32G4)
|
|
// assuming 24MHz clock
|
|
#define CAN_DEFAULT_PRESCALER (16)
|
|
#else
|
|
// assuming 48MHz clock
|
|
#define CAN_DEFAULT_PRESCALER (32)
|
|
#endif
|
|
#define CAN_DEFAULT_SJW (1)
|
|
#define CAN_DEFAULT_BS1 (8)
|
|
#define CAN_DEFAULT_BS2 (3)
|
|
|
|
#define CAN_MAXIMUM_NBRP (512)
|
|
#define CAN_MAXIMUM_NBS1 (256)
|
|
#define CAN_MAXIMUM_NBS2 (128)
|
|
// Minimum Nominal time segment for FDCAN is 2.
|
|
#define CAN_MINIMUM_TSEG (2)
|
|
|
|
#define CAN_MAXIMUM_DBRP (32)
|
|
#define CAN_MAXIMUM_DBS1 (32)
|
|
#define CAN_MAXIMUM_DBS2 (16)
|
|
|
|
#define CAN1_RX0_IRQn FDCAN1_IT0_IRQn
|
|
#define CAN1_RX1_IRQn FDCAN1_IT1_IRQn
|
|
#if defined(CAN2)
|
|
#define CAN2_RX0_IRQn FDCAN2_IT0_IRQn
|
|
#define CAN2_RX1_IRQn FDCAN2_IT1_IRQn
|
|
#endif
|
|
#else
|
|
|
|
#define CAN_MAX_FILTER (28)
|
|
#define CAN_MAX_DATA_FRAME (8)
|
|
|
|
#define CAN_DEFAULT_PRESCALER (100)
|
|
#define CAN_DEFAULT_SJW (1)
|
|
#define CAN_DEFAULT_BS1 (6)
|
|
#define CAN_DEFAULT_BS2 (8)
|
|
|
|
#define CAN_MAXIMUM_NBRP (1024)
|
|
#define CAN_MAXIMUM_NBS1 (16)
|
|
#define CAN_MAXIMUM_NBS2 (8)
|
|
#define CAN_MINIMUM_TSEG (1)
|
|
|
|
static uint8_t can2_start_bank = 14;
|
|
|
|
#endif
|
|
|
|
static mp_obj_t pyb_can_deinit(mp_obj_t self_in);
|
|
|
|
void pyb_can_init0(void) {
|
|
for (uint i = 0; i < MP_ARRAY_SIZE(MP_STATE_PORT(pyb_can_obj_all)); i++) {
|
|
MP_STATE_PORT(pyb_can_obj_all)[i] = NULL;
|
|
}
|
|
}
|
|
|
|
void pyb_can_deinit_all(void) {
|
|
for (int i = 0; i < MP_ARRAY_SIZE(MP_STATE_PORT(pyb_can_obj_all)); i++) {
|
|
pyb_can_obj_t *can_obj = MP_STATE_PORT(pyb_can_obj_all)[i];
|
|
if (can_obj != NULL) {
|
|
pyb_can_deinit(MP_OBJ_FROM_PTR(can_obj));
|
|
MP_STATE_PORT(pyb_can_obj_all)[i] = NULL;
|
|
}
|
|
}
|
|
}
|
|
|
|
static void pyb_can_print(const mp_print_t *print, mp_obj_t self_in, mp_print_kind_t kind) {
|
|
pyb_can_obj_t *self = MP_OBJ_TO_PTR(self_in);
|
|
if (!self->is_enabled) {
|
|
mp_printf(print, "CAN(%u)", self->can_id);
|
|
} else {
|
|
qstr mode;
|
|
switch (self->can.Init.Mode) {
|
|
case CAN_MODE_NORMAL:
|
|
mode = MP_QSTR_NORMAL;
|
|
break;
|
|
case CAN_MODE_LOOPBACK:
|
|
mode = MP_QSTR_LOOPBACK;
|
|
break;
|
|
case CAN_MODE_SILENT:
|
|
mode = MP_QSTR_SILENT;
|
|
break;
|
|
case CAN_MODE_SILENT_LOOPBACK:
|
|
default:
|
|
mode = MP_QSTR_SILENT_LOOPBACK;
|
|
break;
|
|
}
|
|
mp_printf(print, "CAN(%u, CAN.%q, auto_restart=%q)",
|
|
self->can_id,
|
|
mode,
|
|
#if MICROPY_HW_ENABLE_FDCAN
|
|
MP_QSTR_False // auto_restart not supported on FDCAN hardware
|
|
#else
|
|
(self->can.Instance->MCR & CAN_MCR_ABOM) ? MP_QSTR_True : MP_QSTR_False
|
|
#endif
|
|
);
|
|
}
|
|
}
|
|
|
|
static void pyb_can_get_bit_timing(mp_uint_t baudrate, mp_uint_t sample_point,
|
|
uint32_t max_brp, uint32_t max_bs1, uint32_t max_bs2, uint32_t min_tseg,
|
|
mp_int_t *bs1_out, mp_int_t *bs2_out, mp_int_t *prescaler_out) {
|
|
uint32_t can_kern_clk = can_get_source_freq();
|
|
mp_uint_t max_baud_error = baudrate / 1000; // Allow .1% deviation
|
|
const mp_uint_t MAX_SAMPLE_ERROR = 5; // round to nearest 1%, which is the param resolution
|
|
sample_point *= 10;
|
|
// Calculate CAN bit timing.
|
|
for (uint32_t brp = 1; brp < max_brp; brp++) {
|
|
for (uint32_t bs1 = min_tseg; bs1 < max_bs1; bs1++) {
|
|
for (uint32_t bs2 = min_tseg; bs2 < max_bs2; bs2++) {
|
|
mp_int_t calc_baud = can_kern_clk / (brp * (1 + bs1 + bs2));
|
|
mp_int_t calc_sample = ((1 + bs1) * 1000) / (1 + bs1 + bs2);
|
|
mp_int_t baud_err = baudrate - calc_baud;
|
|
mp_int_t sample_err = sample_point - calc_sample;
|
|
if (abs(baud_err) < max_baud_error &&
|
|
abs(sample_err) < MAX_SAMPLE_ERROR) {
|
|
*bs1_out = bs1;
|
|
*bs2_out = bs2;
|
|
*prescaler_out = brp;
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
mp_raise_msg_varg(&mp_type_ValueError, MP_ERROR_TEXT("couldn't match baudrate %u and sample point %u"), baudrate, sample_point / 10);
|
|
}
|
|
|
|
// init(mode, prescaler=100, *, sjw=1, bs1=6, bs2=8)
|
|
static mp_obj_t pyb_can_init_helper(pyb_can_obj_t *self, size_t n_args, const mp_obj_t *pos_args, mp_map_t *kw_args) {
|
|
enum { ARG_mode, ARG_prescaler, ARG_sjw, ARG_bs1, ARG_bs2, ARG_auto_restart, ARG_baudrate, ARG_sample_point,
|
|
ARG_num_filter_banks, ARG_brs_prescaler, ARG_brs_sjw, ARG_brs_bs1, ARG_brs_bs2, ARG_brs_baudrate, ARG_brs_sample_point };
|
|
static const mp_arg_t allowed_args[] = {
|
|
{ MP_QSTR_mode, MP_ARG_REQUIRED | MP_ARG_INT, {.u_int = CAN_MODE_NORMAL} },
|
|
{ MP_QSTR_prescaler, MP_ARG_INT, {.u_int = CAN_DEFAULT_PRESCALER} },
|
|
{ MP_QSTR_sjw, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = CAN_DEFAULT_SJW} },
|
|
{ MP_QSTR_bs1, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = CAN_DEFAULT_BS1} },
|
|
{ MP_QSTR_bs2, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = CAN_DEFAULT_BS2} },
|
|
{ MP_QSTR_auto_restart, MP_ARG_KW_ONLY | MP_ARG_BOOL, {.u_bool = false} },
|
|
{ MP_QSTR_baudrate, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = 0} },
|
|
{ MP_QSTR_sample_point, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = 75} }, // 75% sampling point
|
|
{ MP_QSTR_num_filter_banks, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = 14} },
|
|
#if MICROPY_HW_ENABLE_FDCAN
|
|
{ MP_QSTR_brs_prescaler, MP_ARG_INT, {.u_int = CAN_DEFAULT_PRESCALER} },
|
|
{ MP_QSTR_brs_sjw, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = CAN_DEFAULT_SJW} },
|
|
{ MP_QSTR_brs_bs1, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = CAN_DEFAULT_BS1} },
|
|
{ MP_QSTR_brs_bs2, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = CAN_DEFAULT_BS2} },
|
|
{ MP_QSTR_brs_baudrate, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = 0} },
|
|
{ MP_QSTR_brs_sample_point, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = 0} }
|
|
#endif
|
|
};
|
|
|
|
// parse args
|
|
mp_arg_val_t args[MP_ARRAY_SIZE(allowed_args)];
|
|
mp_arg_parse_all(n_args, pos_args, kw_args, MP_ARRAY_SIZE(allowed_args), allowed_args, args);
|
|
|
|
// set the CAN configuration values
|
|
memset(&self->can, 0, sizeof(self->can));
|
|
|
|
// Calculate CAN nominal bit timing from baudrate if provided
|
|
if (args[ARG_baudrate].u_int != 0) {
|
|
pyb_can_get_bit_timing(args[ARG_baudrate].u_int, args[ARG_sample_point].u_int,
|
|
CAN_MAXIMUM_NBRP, CAN_MAXIMUM_NBS1, CAN_MAXIMUM_NBS2, CAN_MINIMUM_TSEG,
|
|
&args[ARG_bs1].u_int, &args[ARG_bs2].u_int, &args[ARG_prescaler].u_int);
|
|
}
|
|
|
|
#if MICROPY_HW_ENABLE_FDCAN
|
|
// If no sample point is provided for data bit timing, use the nominal sample point.
|
|
if (args[ARG_brs_sample_point].u_int == 0) {
|
|
args[ARG_brs_sample_point].u_int = args[ARG_sample_point].u_int;
|
|
}
|
|
// Calculate CAN data bit timing from baudrate if provided
|
|
if (args[ARG_brs_baudrate].u_int != 0) {
|
|
pyb_can_get_bit_timing(args[ARG_brs_baudrate].u_int, args[ARG_brs_sample_point].u_int,
|
|
CAN_MAXIMUM_DBRP, CAN_MAXIMUM_DBS1, CAN_MAXIMUM_DBS2, 1,
|
|
&args[ARG_brs_bs1].u_int, &args[ARG_brs_bs2].u_int, &args[ARG_brs_prescaler].u_int);
|
|
}
|
|
// Set BRS bit timings.
|
|
self->can.Init.DataPrescaler = args[ARG_brs_prescaler].u_int;
|
|
self->can.Init.DataSyncJumpWidth = args[ARG_brs_sjw].u_int;
|
|
self->can.Init.DataTimeSeg1 = args[ARG_brs_bs1].u_int; // DataTimeSeg1 = Propagation_segment + Phase_segment_1
|
|
self->can.Init.DataTimeSeg2 = args[ARG_brs_bs2].u_int;
|
|
#else
|
|
// Init filter banks for classic CAN.
|
|
can2_start_bank = args[ARG_num_filter_banks].u_int;
|
|
int bank_offs = (self->can_id == 2) ? can2_start_bank : 0;
|
|
for (int f = 0; f < CAN_MAX_FILTER; f++) {
|
|
can_clearfilter(&self->can, f + bank_offs, can2_start_bank);
|
|
}
|
|
#endif
|
|
|
|
mp_uint_t mode = args[ARG_mode].u_int;
|
|
#if !MICROPY_HW_ENABLE_FDCAN
|
|
mode = mode << 4; // Undo the '>> 4' set when defining the bxCAN Python constants further down in this file
|
|
#endif
|
|
|
|
if (!can_init(&self->can, self->can_id, CAN_TX_FIFO, mode, args[ARG_prescaler].u_int, args[ARG_sjw].u_int,
|
|
args[ARG_bs1].u_int, args[ARG_bs2].u_int, args[ARG_auto_restart].u_bool)) {
|
|
mp_raise_msg_varg(&mp_type_ValueError, MP_ERROR_TEXT("CAN(%d) init failure"), self->can_id);
|
|
}
|
|
|
|
self->is_enabled = true;
|
|
self->num_error_warning = 0;
|
|
self->num_error_passive = 0;
|
|
self->num_bus_off = 0;
|
|
|
|
return mp_const_none;
|
|
}
|
|
|
|
// CAN(bus, ...)
|
|
static mp_obj_t pyb_can_make_new(const mp_obj_type_t *type, size_t n_args, size_t n_kw, const mp_obj_t *args) {
|
|
// check arguments
|
|
mp_arg_check_num(n_args, n_kw, 1, MP_OBJ_FUN_ARGS_MAX, true);
|
|
|
|
// work out port
|
|
mp_uint_t can_idx = machine_can_get_index(args[0]); // 0-based index
|
|
|
|
pyb_can_obj_t *self;
|
|
if (MP_STATE_PORT(pyb_can_obj_all)[can_idx] == NULL) {
|
|
self = mp_obj_malloc(pyb_can_obj_t, &pyb_can_type);
|
|
self->can_id = can_idx + 1; // ID is 1-based
|
|
self->is_enabled = false;
|
|
MP_STATE_PORT(pyb_can_obj_all)[can_idx] = self;
|
|
} else {
|
|
self = MP_STATE_PORT(pyb_can_obj_all)[can_idx];
|
|
}
|
|
|
|
if (!self->is_enabled || n_args > 1) {
|
|
if (self->is_enabled) {
|
|
// The caller is requesting a reconfiguration of the hardware
|
|
// this can only be done if the hardware is in init mode
|
|
pyb_can_deinit(MP_OBJ_FROM_PTR(self));
|
|
}
|
|
|
|
self->rxcallback0 = mp_const_none;
|
|
self->rxcallback1 = mp_const_none;
|
|
self->rx_state0 = RX_STATE_FIFO_EMPTY;
|
|
self->rx_state1 = RX_STATE_FIFO_EMPTY;
|
|
|
|
if (n_args > 1 || n_kw > 0) {
|
|
// start the peripheral
|
|
mp_map_t kw_args;
|
|
mp_map_init_fixed_table(&kw_args, n_kw, args + n_args);
|
|
pyb_can_init_helper(self, n_args - 1, args + 1, &kw_args);
|
|
}
|
|
}
|
|
|
|
return MP_OBJ_FROM_PTR(self);
|
|
}
|
|
|
|
static mp_obj_t pyb_can_init(size_t n_args, const mp_obj_t *args, mp_map_t *kw_args) {
|
|
return pyb_can_init_helper(MP_OBJ_TO_PTR(args[0]), n_args - 1, args + 1, kw_args);
|
|
}
|
|
static MP_DEFINE_CONST_FUN_OBJ_KW(pyb_can_init_obj, 1, pyb_can_init);
|
|
|
|
// deinit()
|
|
static mp_obj_t pyb_can_deinit(mp_obj_t self_in) {
|
|
pyb_can_obj_t *self = MP_OBJ_TO_PTR(self_in);
|
|
can_deinit(&self->can);
|
|
self->is_enabled = false;
|
|
return mp_const_none;
|
|
}
|
|
static MP_DEFINE_CONST_FUN_OBJ_1(pyb_can_deinit_obj, pyb_can_deinit);
|
|
|
|
// Force a software restart of the controller, to allow transmission after a bus error
|
|
static mp_obj_t pyb_can_restart(mp_obj_t self_in) {
|
|
pyb_can_obj_t *self = MP_OBJ_TO_PTR(self_in);
|
|
if (!self->is_enabled) {
|
|
mp_raise_ValueError(NULL);
|
|
}
|
|
can_restart(&self->can);
|
|
return mp_const_none;
|
|
}
|
|
static MP_DEFINE_CONST_FUN_OBJ_1(pyb_can_restart_obj, pyb_can_restart);
|
|
|
|
// Get the state of the controller
|
|
static mp_obj_t pyb_can_state(mp_obj_t self_in) {
|
|
pyb_can_obj_t *self = MP_OBJ_TO_PTR(self_in);
|
|
if (self->is_enabled) {
|
|
return MP_OBJ_NEW_SMALL_INT(can_get_state(&self->can));
|
|
} else {
|
|
return MP_OBJ_NEW_SMALL_INT(CAN_STATE_STOPPED);
|
|
}
|
|
}
|
|
static MP_DEFINE_CONST_FUN_OBJ_1(pyb_can_state_obj, pyb_can_state);
|
|
|
|
// Get info about error states and TX/RX buffers
|
|
static mp_obj_t pyb_can_info(size_t n_args, const mp_obj_t *args) {
|
|
pyb_can_obj_t *self = MP_OBJ_TO_PTR(args[0]);
|
|
mp_obj_list_t *list = mp_obj_list_optional_arg(n_args > 1 ? args[1] : mp_const_none, 8);
|
|
can_counters_t hw_counters;
|
|
|
|
can_get_counters(&self->can, &hw_counters);
|
|
|
|
list->items[0] = MP_OBJ_NEW_SMALL_INT(hw_counters.tec);
|
|
list->items[1] = MP_OBJ_NEW_SMALL_INT(hw_counters.rec);
|
|
list->items[2] = MP_OBJ_NEW_SMALL_INT(self->num_error_warning);
|
|
list->items[3] = MP_OBJ_NEW_SMALL_INT(self->num_error_passive);
|
|
list->items[4] = MP_OBJ_NEW_SMALL_INT(self->num_bus_off);
|
|
list->items[5] = MP_OBJ_NEW_SMALL_INT(hw_counters.tx_pending);
|
|
list->items[6] = MP_OBJ_NEW_SMALL_INT(hw_counters.rx_fifo0_pending);
|
|
list->items[7] = MP_OBJ_NEW_SMALL_INT(hw_counters.rx_fifo1_pending);
|
|
|
|
return MP_OBJ_FROM_PTR(list);
|
|
}
|
|
static MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(pyb_can_info_obj, 1, 2, pyb_can_info);
|
|
|
|
// any(fifo) - return `True` if any message waiting on the FIFO, else `False`
|
|
static mp_obj_t pyb_can_any(mp_obj_t self_in, mp_obj_t fifo_in) {
|
|
pyb_can_obj_t *self = MP_OBJ_TO_PTR(self_in);
|
|
can_rx_fifo_t fifo = mp_obj_get_int(fifo_in);
|
|
return mp_obj_new_bool(can_is_rx_pending(&self->can, fifo) != 0);
|
|
}
|
|
static MP_DEFINE_CONST_FUN_OBJ_2(pyb_can_any_obj, pyb_can_any);
|
|
|
|
// send(send, addr, *, timeout=5000)
|
|
static mp_obj_t pyb_can_send(size_t n_args, const mp_obj_t *pos_args, mp_map_t *kw_args) {
|
|
enum { ARG_data, ARG_id, ARG_timeout, ARG_rtr, ARG_extframe, ARG_fdf, ARG_brs };
|
|
static const mp_arg_t allowed_args[] = {
|
|
{ MP_QSTR_data, MP_ARG_REQUIRED | MP_ARG_OBJ, {.u_obj = MP_OBJ_NULL} },
|
|
{ MP_QSTR_id, MP_ARG_REQUIRED | MP_ARG_INT, {.u_int = 0} },
|
|
{ MP_QSTR_timeout, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = 0} },
|
|
{ MP_QSTR_rtr, MP_ARG_KW_ONLY | MP_ARG_BOOL, {.u_bool = false} },
|
|
{ MP_QSTR_extframe, MP_ARG_BOOL, {.u_bool = false} },
|
|
#if MICROPY_HW_ENABLE_FDCAN
|
|
{ MP_QSTR_fdf, MP_ARG_KW_ONLY | MP_ARG_BOOL, {.u_bool = false} },
|
|
{ MP_QSTR_brs, MP_ARG_KW_ONLY | MP_ARG_BOOL, {.u_bool = false} },
|
|
#endif
|
|
};
|
|
|
|
// parse args
|
|
pyb_can_obj_t *self = MP_OBJ_TO_PTR(pos_args[0]);
|
|
mp_arg_val_t args[MP_ARRAY_SIZE(allowed_args)];
|
|
mp_arg_parse_all(n_args - 1, pos_args + 1, kw_args, MP_ARRAY_SIZE(allowed_args), allowed_args, args);
|
|
|
|
// get the buffer to send from
|
|
mp_buffer_info_t bufinfo;
|
|
uint8_t data[1];
|
|
pyb_buf_get_for_send(args[ARG_data].u_obj, &bufinfo, data);
|
|
|
|
if (bufinfo.len > CAN_MAX_DATA_FRAME) {
|
|
mp_raise_ValueError(MP_ERROR_TEXT("CAN data field too long"));
|
|
}
|
|
|
|
// send the data
|
|
HAL_StatusTypeDef status;
|
|
CanTxMsgTypeDef tx_msg;
|
|
|
|
#if MICROPY_HW_ENABLE_FDCAN
|
|
uint8_t tx_data[CAN_MAX_DATA_FRAME];
|
|
memset(tx_data, 0, sizeof(tx_data));
|
|
|
|
tx_msg.MessageMarker = 0;
|
|
tx_msg.ErrorStateIndicator = FDCAN_ESI_ACTIVE;
|
|
tx_msg.TxEventFifoControl = FDCAN_NO_TX_EVENTS;
|
|
|
|
if (args[ARG_extframe].u_bool == true) {
|
|
tx_msg.Identifier = args[ARG_id].u_int & 0x1FFFFFFF;
|
|
tx_msg.IdType = FDCAN_EXTENDED_ID;
|
|
} else {
|
|
tx_msg.Identifier = args[ARG_id].u_int & 0x7FF;
|
|
tx_msg.IdType = FDCAN_STANDARD_ID;
|
|
}
|
|
if (args[ARG_rtr].u_bool == false) {
|
|
tx_msg.TxFrameType = FDCAN_DATA_FRAME;
|
|
} else {
|
|
tx_msg.TxFrameType = FDCAN_REMOTE_FRAME;
|
|
}
|
|
if (args[ARG_fdf].u_bool == false) {
|
|
tx_msg.FDFormat = FDCAN_CLASSIC_CAN;
|
|
} else {
|
|
tx_msg.FDFormat = FDCAN_FD_CAN;
|
|
}
|
|
if (args[ARG_brs].u_bool == false) {
|
|
tx_msg.BitRateSwitch = FDCAN_BRS_OFF;
|
|
} else {
|
|
tx_msg.BitRateSwitch = FDCAN_BRS_ON;
|
|
}
|
|
tx_msg.DataLength = bufinfo.len; // Converted to DLC encoding inside can_transmit
|
|
#else
|
|
tx_msg.DLC = bufinfo.len;
|
|
uint8_t *tx_data = tx_msg.Data; // Data is uint32_t but holds only 1 byte
|
|
|
|
if (args[ARG_extframe].u_bool == true) {
|
|
tx_msg.ExtId = args[ARG_id].u_int & 0x1FFFFFFF;
|
|
tx_msg.IDE = CAN_ID_EXT;
|
|
} else {
|
|
tx_msg.StdId = args[ARG_id].u_int & 0x7FF;
|
|
tx_msg.IDE = CAN_ID_STD;
|
|
}
|
|
if (args[ARG_rtr].u_bool == false) {
|
|
tx_msg.RTR = CAN_RTR_DATA;
|
|
} else {
|
|
tx_msg.RTR = CAN_RTR_REMOTE;
|
|
}
|
|
#endif
|
|
|
|
for (mp_uint_t i = 0; i < bufinfo.len; i++) {
|
|
tx_data[i] = ((byte *)bufinfo.buf)[i];
|
|
}
|
|
|
|
status = can_transmit(&self->can, &tx_msg, tx_data, args[ARG_timeout].u_int);
|
|
|
|
if (status != HAL_OK) {
|
|
mp_hal_raise(status);
|
|
}
|
|
|
|
return mp_const_none;
|
|
}
|
|
static MP_DEFINE_CONST_FUN_OBJ_KW(pyb_can_send_obj, 1, pyb_can_send);
|
|
|
|
// recv(fifo, list=None, *, timeout=5000)
|
|
static mp_obj_t pyb_can_recv(size_t n_args, const mp_obj_t *pos_args, mp_map_t *kw_args) {
|
|
enum { ARG_fifo, ARG_list, ARG_timeout };
|
|
static const mp_arg_t allowed_args[] = {
|
|
{ MP_QSTR_fifo, MP_ARG_REQUIRED | MP_ARG_INT, {.u_int = 0} },
|
|
{ MP_QSTR_list, MP_ARG_OBJ, {.u_rom_obj = MP_ROM_NONE} },
|
|
{ MP_QSTR_timeout, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = 5000} },
|
|
};
|
|
|
|
// parse args
|
|
pyb_can_obj_t *self = MP_OBJ_TO_PTR(pos_args[0]);
|
|
mp_arg_val_t args[MP_ARRAY_SIZE(allowed_args)];
|
|
mp_arg_parse_all(n_args - 1, pos_args + 1, kw_args, MP_ARRAY_SIZE(allowed_args), allowed_args, args);
|
|
|
|
// receive the data
|
|
CanRxMsgTypeDef rx_msg;
|
|
#if MICROPY_HW_ENABLE_FDCAN
|
|
uint8_t rx_data[CAN_MAX_DATA_FRAME];
|
|
#else
|
|
uint8_t *rx_data = rx_msg.Data;
|
|
#endif
|
|
|
|
can_rx_fifo_t fifo = args[ARG_fifo].u_int;
|
|
if (fifo != CAN_RX_FIFO0 && fifo != CAN_RX_FIFO1) {
|
|
mp_raise_TypeError(NULL);
|
|
}
|
|
|
|
int ret = can_receive(&self->can, fifo, &rx_msg, rx_data, args[ARG_timeout].u_int);
|
|
if (ret < 0) {
|
|
mp_raise_OSError(-ret);
|
|
}
|
|
|
|
#if MICROPY_HW_ENABLE_FDCAN
|
|
uint32_t rx_dlc = rx_msg.DataLength;
|
|
#else
|
|
uint32_t rx_dlc = rx_msg.DLC;
|
|
#endif
|
|
|
|
// Manage the rx state machine
|
|
if ((fifo == CAN_RX_FIFO0 && self->rxcallback0 != mp_const_none) ||
|
|
(fifo == CAN_RX_FIFO1 && self->rxcallback1 != mp_const_none)) {
|
|
bool fifo_empty = can_is_rx_pending(&self->can, fifo) == 0;
|
|
byte *state = (fifo == CAN_RX_FIFO0) ? &self->rx_state0 : &self->rx_state1;
|
|
switch (*state) {
|
|
case RX_STATE_FIFO_EMPTY:
|
|
break;
|
|
case RX_STATE_MESSAGE_PENDING:
|
|
if (fifo_empty) {
|
|
*state = RX_STATE_FIFO_EMPTY;
|
|
}
|
|
break;
|
|
case RX_STATE_FIFO_FULL:
|
|
*state = RX_STATE_MESSAGE_PENDING;
|
|
break;
|
|
case RX_STATE_FIFO_OVERFLOW:
|
|
*state = RX_STATE_MESSAGE_PENDING;
|
|
break;
|
|
}
|
|
|
|
// Re-enable any interrupts that were disabled in RX IRQ handlers
|
|
can_enable_rx_interrupts(&self->can, fifo, fifo_empty);
|
|
}
|
|
|
|
// Create or get the list, that will hold the return values
|
|
// Also populate the fifth element, either a new bytes or reuse existing memoryview
|
|
mp_obj_list_t *list = mp_obj_list_optional_arg(args[ARG_list].u_obj, 5);
|
|
mp_obj_t *items = list->items;
|
|
if (MP_OBJ_FROM_PTR(list) != args[ARG_list].u_obj) {
|
|
// If newly allocated, create item 4
|
|
items[4] = mp_obj_new_bytes(rx_data, rx_dlc);
|
|
} else {
|
|
// Fifth element must be a memoryview which we assume points to a
|
|
// byte-like array which is large enough, and then we resize it inplace
|
|
if (!mp_obj_is_type(items[4], &mp_type_memoryview)) {
|
|
mp_raise_TypeError(NULL);
|
|
}
|
|
mp_obj_array_t *mv = MP_OBJ_TO_PTR(items[4]);
|
|
if (!(mv->typecode == (MP_OBJ_ARRAY_TYPECODE_FLAG_RW | BYTEARRAY_TYPECODE)
|
|
|| (mv->typecode | 0x20) == (MP_OBJ_ARRAY_TYPECODE_FLAG_RW | 'b'))) {
|
|
mp_raise_ValueError(NULL);
|
|
}
|
|
mv->len = rx_dlc;
|
|
memcpy(mv->items, rx_data, rx_dlc);
|
|
}
|
|
|
|
// Populate the first 4 values of the tuple/list
|
|
#if MICROPY_HW_ENABLE_FDCAN
|
|
items[0] = MP_OBJ_NEW_SMALL_INT(rx_msg.Identifier);
|
|
items[1] = mp_obj_new_bool(rx_msg.IdType == FDCAN_EXTENDED_ID);
|
|
items[2] = rx_msg.RxFrameType == FDCAN_REMOTE_FRAME ? mp_const_true : mp_const_false;
|
|
items[3] = MP_OBJ_NEW_SMALL_INT(rx_msg.FilterIndex);
|
|
#else
|
|
items[0] = MP_OBJ_NEW_SMALL_INT((rx_msg.IDE == CAN_ID_STD ? rx_msg.StdId : rx_msg.ExtId));
|
|
items[1] = mp_obj_new_bool(rx_msg.IDE == CAN_ID_EXT);
|
|
items[2] = rx_msg.RTR == CAN_RTR_REMOTE ? mp_const_true : mp_const_false;
|
|
items[3] = MP_OBJ_NEW_SMALL_INT(rx_msg.FMI);
|
|
#endif
|
|
|
|
// Return the result
|
|
return MP_OBJ_FROM_PTR(list);
|
|
}
|
|
static MP_DEFINE_CONST_FUN_OBJ_KW(pyb_can_recv_obj, 1, pyb_can_recv);
|
|
|
|
static mp_obj_t pyb_can_clearfilter(size_t n_args, const mp_obj_t *pos_args, mp_map_t *kw_args) {
|
|
enum { ARG_extframe };
|
|
static const mp_arg_t allowed_args[] = {
|
|
{ MP_QSTR_extframe, MP_ARG_BOOL, {.u_bool = false} },
|
|
};
|
|
|
|
// parse args
|
|
pyb_can_obj_t *self = MP_OBJ_TO_PTR(pos_args[0]);
|
|
mp_int_t f = mp_obj_get_int(pos_args[1]);
|
|
mp_arg_val_t args[MP_ARRAY_SIZE(allowed_args)];
|
|
mp_arg_parse_all(n_args - 2, pos_args + 2, kw_args, MP_ARRAY_SIZE(allowed_args), allowed_args, args);
|
|
|
|
#if MICROPY_HW_ENABLE_FDCAN
|
|
can_clearfilter(&self->can, f, args[ARG_extframe].u_bool);
|
|
#else
|
|
if (self->can_id == 2) {
|
|
f += can2_start_bank;
|
|
}
|
|
can_clearfilter(&self->can, f, can2_start_bank);
|
|
#endif
|
|
return mp_const_none;
|
|
}
|
|
static MP_DEFINE_CONST_FUN_OBJ_KW(pyb_can_clearfilter_obj, 2, pyb_can_clearfilter);
|
|
|
|
// setfilter(bank, mode, fifo, params, *, rtr)
|
|
#define EXTENDED_ID_TO_16BIT_FILTER(id) (((id & 0xC00000) >> 13) | ((id & 0x38000) >> 15)) | 8
|
|
static mp_obj_t pyb_can_setfilter(size_t n_args, const mp_obj_t *pos_args, mp_map_t *kw_args) {
|
|
enum { ARG_bank, ARG_mode, ARG_fifo, ARG_params, ARG_rtr, ARG_extframe };
|
|
static const mp_arg_t allowed_args[] = {
|
|
{ MP_QSTR_bank, MP_ARG_REQUIRED | MP_ARG_INT, {.u_int = 0} },
|
|
{ MP_QSTR_mode, MP_ARG_REQUIRED | MP_ARG_INT, {.u_int = 0} },
|
|
{ MP_QSTR_fifo, MP_ARG_REQUIRED | MP_ARG_INT, {.u_int = CAN_FILTER_FIFO0} },
|
|
{ MP_QSTR_params, MP_ARG_REQUIRED | MP_ARG_OBJ, {.u_obj = MP_OBJ_NULL} },
|
|
{ MP_QSTR_rtr, MP_ARG_KW_ONLY | MP_ARG_OBJ, {.u_obj = MP_OBJ_NULL} },
|
|
{ MP_QSTR_extframe, MP_ARG_BOOL, {.u_bool = false} },
|
|
};
|
|
|
|
// parse args
|
|
pyb_can_obj_t *self = MP_OBJ_TO_PTR(pos_args[0]);
|
|
mp_arg_val_t args[MP_ARRAY_SIZE(allowed_args)];
|
|
mp_arg_parse_all(n_args - 1, pos_args + 1, kw_args, MP_ARRAY_SIZE(allowed_args), allowed_args, args);
|
|
|
|
#if MICROPY_HW_ENABLE_FDCAN
|
|
FDCAN_FilterTypeDef filter = {0};
|
|
if (args[ARG_extframe].u_bool == true) {
|
|
filter.IdType = FDCAN_EXTENDED_ID;
|
|
} else {
|
|
filter.IdType = FDCAN_STANDARD_ID;
|
|
}
|
|
|
|
filter.FilterIndex = args[ARG_bank].u_int;
|
|
// Check filter index.
|
|
if ((filter.IdType == FDCAN_STANDARD_ID && filter.FilterIndex >= self->can.Init.StdFiltersNbr) ||
|
|
(filter.IdType == FDCAN_EXTENDED_ID && filter.FilterIndex >= self->can.Init.ExtFiltersNbr)) {
|
|
goto error;
|
|
}
|
|
|
|
// Check filter mode
|
|
if (((args[ARG_mode].u_int != FDCAN_FILTER_RANGE) &&
|
|
(args[ARG_mode].u_int != FDCAN_FILTER_DUAL) &&
|
|
(args[ARG_mode].u_int != FDCAN_FILTER_MASK))) {
|
|
goto error;
|
|
}
|
|
|
|
// Check FIFO index.
|
|
if (args[ARG_fifo].u_int == 0) {
|
|
filter.FilterConfig = FDCAN_FILTER_TO_RXFIFO0;
|
|
} else if (args[ARG_fifo].u_int == 1) {
|
|
filter.FilterConfig = FDCAN_FILTER_TO_RXFIFO1;
|
|
} else {
|
|
goto error;
|
|
}
|
|
|
|
size_t len;
|
|
mp_obj_t *params;
|
|
mp_obj_get_array(args[ARG_params].u_obj, &len, ¶ms);
|
|
if (len != 2) { // Check params len
|
|
goto error;
|
|
}
|
|
filter.FilterID1 = mp_obj_get_int(params[0]);
|
|
filter.FilterID2 = mp_obj_get_int(params[1]);
|
|
filter.FilterType = args[ARG_mode].u_int;
|
|
HAL_FDCAN_ConfigFilter(&self->can, &filter);
|
|
|
|
#else
|
|
|
|
size_t len;
|
|
size_t rtr_len;
|
|
mp_uint_t rtr_masks[4] = {0, 0, 0, 0};
|
|
mp_obj_t *rtr_flags;
|
|
mp_obj_t *params;
|
|
mp_obj_get_array(args[ARG_params].u_obj, &len, ¶ms);
|
|
if (args[ARG_rtr].u_obj != MP_OBJ_NULL) {
|
|
mp_obj_get_array(args[ARG_rtr].u_obj, &rtr_len, &rtr_flags);
|
|
}
|
|
|
|
CAN_FilterConfTypeDef filter;
|
|
if (args[ARG_mode].u_int == MASK16 || args[ARG_mode].u_int == LIST16) {
|
|
if (len != 4) {
|
|
goto error;
|
|
}
|
|
filter.FilterScale = CAN_FILTERSCALE_16BIT;
|
|
if (args[ARG_extframe].u_bool == true) {
|
|
if (args[ARG_rtr].u_obj != MP_OBJ_NULL) {
|
|
if (args[ARG_mode].u_int == MASK16) {
|
|
rtr_masks[0] = mp_obj_get_int(rtr_flags[0]) ? 0x02 : 0;
|
|
rtr_masks[1] = 0x02;
|
|
rtr_masks[2] = mp_obj_get_int(rtr_flags[1]) ? 0x02 : 0;
|
|
rtr_masks[3] = 0x02;
|
|
} else { // LIST16
|
|
rtr_masks[0] = mp_obj_get_int(rtr_flags[0]) ? 0x02 : 0;
|
|
rtr_masks[1] = mp_obj_get_int(rtr_flags[1]) ? 0x02 : 0;
|
|
rtr_masks[2] = mp_obj_get_int(rtr_flags[2]) ? 0x02 : 0;
|
|
rtr_masks[3] = mp_obj_get_int(rtr_flags[3]) ? 0x02 : 0;
|
|
}
|
|
}
|
|
filter.FilterIdLow = EXTENDED_ID_TO_16BIT_FILTER(mp_obj_get_int(params[0])) | rtr_masks[0]; // id1
|
|
filter.FilterMaskIdLow = EXTENDED_ID_TO_16BIT_FILTER(mp_obj_get_int(params[1])) | rtr_masks[1]; // mask1
|
|
filter.FilterIdHigh = EXTENDED_ID_TO_16BIT_FILTER(mp_obj_get_int(params[2])) | rtr_masks[2]; // id2
|
|
filter.FilterMaskIdHigh = EXTENDED_ID_TO_16BIT_FILTER(mp_obj_get_int(params[3])) | rtr_masks[3]; // mask2
|
|
} else { // Basic frames
|
|
if (args[ARG_rtr].u_obj != MP_OBJ_NULL) {
|
|
if (args[ARG_mode].u_int == MASK16) {
|
|
rtr_masks[0] = mp_obj_get_int(rtr_flags[0]) ? 0x10 : 0;
|
|
rtr_masks[1] = 0x10;
|
|
rtr_masks[2] = mp_obj_get_int(rtr_flags[1]) ? 0x10 : 0;
|
|
rtr_masks[3] = 0x10;
|
|
} else { // LIST16
|
|
rtr_masks[0] = mp_obj_get_int(rtr_flags[0]) ? 0x10 : 0;
|
|
rtr_masks[1] = mp_obj_get_int(rtr_flags[1]) ? 0x10 : 0;
|
|
rtr_masks[2] = mp_obj_get_int(rtr_flags[2]) ? 0x10 : 0;
|
|
rtr_masks[3] = mp_obj_get_int(rtr_flags[3]) ? 0x10 : 0;
|
|
}
|
|
}
|
|
filter.FilterIdLow = (mp_obj_get_int(params[0]) << 5) | rtr_masks[0]; // id1
|
|
filter.FilterMaskIdLow = (mp_obj_get_int(params[1]) << 5) | rtr_masks[1]; // mask1
|
|
filter.FilterIdHigh = (mp_obj_get_int(params[2]) << 5) | rtr_masks[2]; // id2
|
|
filter.FilterMaskIdHigh = (mp_obj_get_int(params[3]) << 5) | rtr_masks[3]; // mask2
|
|
}
|
|
if (args[ARG_mode].u_int == MASK16) {
|
|
filter.FilterMode = CAN_FILTERMODE_IDMASK;
|
|
}
|
|
if (args[ARG_mode].u_int == LIST16) {
|
|
filter.FilterMode = CAN_FILTERMODE_IDLIST;
|
|
}
|
|
} else if (args[ARG_mode].u_int == MASK32 || args[ARG_mode].u_int == LIST32) {
|
|
if (len != 2) {
|
|
goto error;
|
|
}
|
|
filter.FilterScale = CAN_FILTERSCALE_32BIT;
|
|
if (args[ARG_rtr].u_obj != MP_OBJ_NULL) {
|
|
if (args[ARG_mode].u_int == MASK32) {
|
|
rtr_masks[0] = mp_obj_get_int(rtr_flags[0]) ? 0x02 : 0;
|
|
rtr_masks[1] = 0x02;
|
|
} else { // LIST32
|
|
rtr_masks[0] = mp_obj_get_int(rtr_flags[0]) ? 0x02 : 0;
|
|
rtr_masks[1] = mp_obj_get_int(rtr_flags[1]) ? 0x02 : 0;
|
|
}
|
|
}
|
|
filter.FilterIdHigh = (mp_obj_get_int(params[0]) & 0x1FFFE000) >> 13;
|
|
filter.FilterIdLow = (((mp_obj_get_int(params[0]) & 0x00001FFF) << 3) | 4) | rtr_masks[0];
|
|
filter.FilterMaskIdHigh = (mp_obj_get_int(params[1]) & 0x1FFFE000) >> 13;
|
|
filter.FilterMaskIdLow = (((mp_obj_get_int(params[1]) & 0x00001FFF) << 3) | 4) | rtr_masks[1];
|
|
if (args[ARG_mode].u_int == MASK32) {
|
|
filter.FilterMode = CAN_FILTERMODE_IDMASK;
|
|
}
|
|
if (args[ARG_mode].u_int == LIST32) {
|
|
filter.FilterMode = CAN_FILTERMODE_IDLIST;
|
|
}
|
|
} else {
|
|
goto error;
|
|
}
|
|
|
|
filter.FilterFIFOAssignment = args[ARG_fifo].u_int;
|
|
filter.FilterNumber = args[ARG_bank].u_int;
|
|
if (self->can_id == 1) {
|
|
if (filter.FilterNumber >= can2_start_bank) {
|
|
goto error;
|
|
}
|
|
} else if (self->can_id == 2) {
|
|
filter.FilterNumber = filter.FilterNumber + can2_start_bank;
|
|
if (filter.FilterNumber > 27) {
|
|
goto error;
|
|
}
|
|
} else {
|
|
if (filter.FilterNumber > 13) { // CAN3 is independent and has its own 14 filters.
|
|
goto error;
|
|
}
|
|
}
|
|
filter.FilterActivation = ENABLE;
|
|
filter.BankNumber = can2_start_bank;
|
|
HAL_CAN_ConfigFilter(&self->can, &filter);
|
|
#endif
|
|
|
|
return mp_const_none;
|
|
error:
|
|
mp_raise_ValueError(MP_ERROR_TEXT("CAN filter parameter error"));
|
|
}
|
|
static MP_DEFINE_CONST_FUN_OBJ_KW(pyb_can_setfilter_obj, 1, pyb_can_setfilter);
|
|
|
|
static mp_obj_t pyb_can_rxcallback(mp_obj_t self_in, mp_obj_t fifo_in, mp_obj_t callback_in) {
|
|
pyb_can_obj_t *self = MP_OBJ_TO_PTR(self_in);
|
|
can_rx_fifo_t fifo = mp_obj_get_int(fifo_in);
|
|
mp_obj_t *callback;
|
|
|
|
callback = (fifo == CAN_RX_FIFO0) ? &self->rxcallback0 : &self->rxcallback1;
|
|
if (callback_in == mp_const_none) {
|
|
can_disable_rx_interrupts(&self->can, fifo);
|
|
*callback = mp_const_none;
|
|
} else if (*callback != mp_const_none) {
|
|
// Rx call backs has already been initialized
|
|
// only the callback function should be changed
|
|
*callback = callback_in;
|
|
} else if (mp_obj_is_callable(callback_in)) {
|
|
*callback = callback_in;
|
|
can_enable_rx_interrupts(&self->can, fifo, true);
|
|
}
|
|
return mp_const_none;
|
|
}
|
|
static MP_DEFINE_CONST_FUN_OBJ_3(pyb_can_rxcallback_obj, pyb_can_rxcallback);
|
|
|
|
static const mp_rom_map_elem_t pyb_can_locals_dict_table[] = {
|
|
// instance methods
|
|
{ MP_ROM_QSTR(MP_QSTR_init), MP_ROM_PTR(&pyb_can_init_obj) },
|
|
{ MP_ROM_QSTR(MP_QSTR_deinit), MP_ROM_PTR(&pyb_can_deinit_obj) },
|
|
{ MP_ROM_QSTR(MP_QSTR_restart), MP_ROM_PTR(&pyb_can_restart_obj) },
|
|
{ MP_ROM_QSTR(MP_QSTR_state), MP_ROM_PTR(&pyb_can_state_obj) },
|
|
{ MP_ROM_QSTR(MP_QSTR_info), MP_ROM_PTR(&pyb_can_info_obj) },
|
|
{ MP_ROM_QSTR(MP_QSTR_any), MP_ROM_PTR(&pyb_can_any_obj) },
|
|
{ MP_ROM_QSTR(MP_QSTR_send), MP_ROM_PTR(&pyb_can_send_obj) },
|
|
{ MP_ROM_QSTR(MP_QSTR_recv), MP_ROM_PTR(&pyb_can_recv_obj) },
|
|
{ MP_ROM_QSTR(MP_QSTR_setfilter), MP_ROM_PTR(&pyb_can_setfilter_obj) },
|
|
{ MP_ROM_QSTR(MP_QSTR_clearfilter), MP_ROM_PTR(&pyb_can_clearfilter_obj) },
|
|
{ MP_ROM_QSTR(MP_QSTR_rxcallback), MP_ROM_PTR(&pyb_can_rxcallback_obj) },
|
|
|
|
#if MICROPY_HW_ENABLE_FDCAN
|
|
{ MP_ROM_QSTR(MP_QSTR_NORMAL), MP_ROM_INT(CAN_MODE_NORMAL) },
|
|
{ MP_ROM_QSTR(MP_QSTR_LOOPBACK), MP_ROM_INT(CAN_MODE_LOOPBACK) },
|
|
{ MP_ROM_QSTR(MP_QSTR_SILENT), MP_ROM_INT(CAN_MODE_SILENT) },
|
|
{ MP_ROM_QSTR(MP_QSTR_SILENT_LOOPBACK), MP_ROM_INT(CAN_MODE_SILENT_LOOPBACK) },
|
|
|
|
{ MP_ROM_QSTR(MP_QSTR_RANGE), MP_ROM_INT(FDCAN_FILTER_RANGE) },
|
|
{ MP_ROM_QSTR(MP_QSTR_DUAL), MP_ROM_INT(FDCAN_FILTER_DUAL) },
|
|
{ MP_ROM_QSTR(MP_QSTR_MASK), MP_ROM_INT(FDCAN_FILTER_MASK) },
|
|
#else
|
|
// class constants
|
|
// Note: we use the ST constants >> 4 so they fit in a small-int. The
|
|
// right-shift is undone when the constants are used in the init function.
|
|
{ MP_ROM_QSTR(MP_QSTR_NORMAL), MP_ROM_INT(CAN_MODE_NORMAL >> 4) },
|
|
{ MP_ROM_QSTR(MP_QSTR_LOOPBACK), MP_ROM_INT(CAN_MODE_LOOPBACK >> 4) },
|
|
{ MP_ROM_QSTR(MP_QSTR_SILENT), MP_ROM_INT(CAN_MODE_SILENT >> 4) },
|
|
{ MP_ROM_QSTR(MP_QSTR_SILENT_LOOPBACK), MP_ROM_INT(CAN_MODE_SILENT_LOOPBACK >> 4) },
|
|
|
|
{ MP_ROM_QSTR(MP_QSTR_MASK16), MP_ROM_INT(MASK16) },
|
|
{ MP_ROM_QSTR(MP_QSTR_LIST16), MP_ROM_INT(LIST16) },
|
|
{ MP_ROM_QSTR(MP_QSTR_MASK32), MP_ROM_INT(MASK32) },
|
|
{ MP_ROM_QSTR(MP_QSTR_LIST32), MP_ROM_INT(LIST32) },
|
|
#endif
|
|
|
|
// values for CAN.state()
|
|
{ MP_ROM_QSTR(MP_QSTR_STOPPED), MP_ROM_INT(CAN_STATE_STOPPED) },
|
|
{ MP_ROM_QSTR(MP_QSTR_ERROR_ACTIVE), MP_ROM_INT(CAN_STATE_ERROR_ACTIVE) },
|
|
{ MP_ROM_QSTR(MP_QSTR_ERROR_WARNING), MP_ROM_INT(CAN_STATE_ERROR_WARNING) },
|
|
{ MP_ROM_QSTR(MP_QSTR_ERROR_PASSIVE), MP_ROM_INT(CAN_STATE_ERROR_PASSIVE) },
|
|
{ MP_ROM_QSTR(MP_QSTR_BUS_OFF), MP_ROM_INT(CAN_STATE_BUS_OFF) },
|
|
};
|
|
static MP_DEFINE_CONST_DICT(pyb_can_locals_dict, pyb_can_locals_dict_table);
|
|
|
|
static mp_uint_t can_ioctl(mp_obj_t self_in, mp_uint_t request, uintptr_t arg, int *errcode) {
|
|
pyb_can_obj_t *self = MP_OBJ_TO_PTR(self_in);
|
|
mp_uint_t ret;
|
|
if (request == MP_STREAM_POLL) {
|
|
uintptr_t flags = arg;
|
|
ret = 0;
|
|
if ((flags & MP_STREAM_POLL_RD)
|
|
&& ((can_is_rx_pending(&self->can, 0) != 0)
|
|
|| (can_is_rx_pending(&self->can, 1) != 0))) {
|
|
ret |= MP_STREAM_POLL_RD;
|
|
}
|
|
#if MICROPY_HW_ENABLE_FDCAN
|
|
if ((flags & MP_STREAM_POLL_WR) && (self->can.Instance->IR & FDCAN_IR_TFE))
|
|
#else
|
|
if ((flags & MP_STREAM_POLL_WR) && (self->can.Instance->TSR & CAN_TSR_TME))
|
|
#endif
|
|
{
|
|
ret |= MP_STREAM_POLL_WR;
|
|
}
|
|
} else {
|
|
*errcode = MP_EINVAL;
|
|
ret = -1;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
// IRQ handler, called from lower layer can.c or fdcan.c in ISR context
|
|
|
|
void pyb_can_irq_handler(uint can_id, can_int_t interrupt, can_rx_fifo_t fifo) {
|
|
mp_obj_t callback;
|
|
pyb_can_obj_t *self;
|
|
byte *state;
|
|
|
|
self = MP_STATE_PORT(pyb_can_obj_all)[can_id - 1];
|
|
if (self == NULL) {
|
|
return; // Should only hit this code path if machine.CAN has enabled interrupt
|
|
}
|
|
|
|
if (fifo == CAN_RX_FIFO0) {
|
|
callback = self->rxcallback0;
|
|
state = &self->rx_state0;
|
|
} else {
|
|
callback = self->rxcallback1;
|
|
state = &self->rx_state1;
|
|
}
|
|
|
|
switch (interrupt) {
|
|
// These interrupts go on to run a Python callback, interrupt arg is the
|
|
// 'interrupt' enum value as an int.
|
|
case CAN_INT_MESSAGE_RECEIVED:
|
|
*state = RX_STATE_MESSAGE_PENDING;
|
|
break;
|
|
case CAN_INT_FIFO_FULL:
|
|
*state = RX_STATE_FIFO_FULL;
|
|
break;
|
|
case CAN_INT_FIFO_OVERFLOW:
|
|
*state = RX_STATE_FIFO_OVERFLOW;
|
|
break;
|
|
|
|
// These interrupts do not run a Python callback
|
|
case CAN_INT_ERR_BUS_OFF:
|
|
self->num_bus_off++;
|
|
return;
|
|
case CAN_INT_ERR_PASSIVE:
|
|
self->num_error_passive++;
|
|
return;
|
|
case CAN_INT_ERR_WARNING:
|
|
self->num_error_warning++;
|
|
return;
|
|
|
|
default:
|
|
return; // CAN_INT_TX_COMPLETE is ignored by pyb.CAN
|
|
}
|
|
|
|
// Run the callback
|
|
if (callback != mp_const_none) {
|
|
mp_sched_lock();
|
|
gc_lock();
|
|
nlr_buf_t nlr;
|
|
if (nlr_push(&nlr) == 0) {
|
|
mp_call_function_2(callback, MP_OBJ_FROM_PTR(self), MP_OBJ_NEW_SMALL_INT(interrupt));
|
|
nlr_pop();
|
|
} else {
|
|
// Uncaught exception; disable the callback so it doesn't run again.
|
|
pyb_can_rxcallback(MP_OBJ_FROM_PTR(self), MP_OBJ_NEW_SMALL_INT(fifo), mp_const_none);
|
|
mp_printf(MICROPY_ERROR_PRINTER, "uncaught exception in CAN(%u) rx interrupt handler\n", self->can_id);
|
|
mp_obj_print_exception(&mp_plat_print, MP_OBJ_FROM_PTR(nlr.ret_val));
|
|
}
|
|
gc_unlock();
|
|
mp_sched_unlock();
|
|
}
|
|
}
|
|
|
|
static const mp_stream_p_t can_stream_p = {
|
|
// .read = can_read, // is read sensible for CAN?
|
|
// .write = can_write, // is write sensible for CAN?
|
|
.ioctl = can_ioctl,
|
|
.is_text = false,
|
|
};
|
|
|
|
MP_DEFINE_CONST_OBJ_TYPE(
|
|
pyb_can_type,
|
|
MP_QSTR_CAN,
|
|
MP_TYPE_FLAG_NONE,
|
|
make_new, pyb_can_make_new,
|
|
print, pyb_can_print,
|
|
protocol, &can_stream_p,
|
|
locals_dict, &pyb_can_locals_dict
|
|
);
|
|
|
|
MP_REGISTER_ROOT_POINTER(struct _pyb_can_obj_t *pyb_can_obj_all[MICROPY_HW_MAX_CAN]);
|
|
|
|
#endif // MICROPY_HW_ENABLE_CAN
|