1de81b426c
Signed-off-by: Richard Henderson <richard.henderson@linaro.org> Message-Id: <20231221031652.119827-42-richard.henderson@linaro.org>
2108 lines
84 KiB
C
2108 lines
84 KiB
C
/*
|
|
* QEMU model of the Xilinx Versal CANFD device.
|
|
*
|
|
* This implementation is based on the following datasheet:
|
|
* https://docs.xilinx.com/v/u/2.0-English/pg223-canfd
|
|
*
|
|
* Copyright (c) 2023 Advanced Micro Devices, Inc.
|
|
*
|
|
* Written-by: Vikram Garhwal <vikram.garhwal@amd.com>
|
|
*
|
|
* Based on QEMU CANFD Device emulation implemented by Jin Yang, Deniz Eren and
|
|
* Pavel Pisa
|
|
*
|
|
* 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 "qemu/osdep.h"
|
|
#include "hw/sysbus.h"
|
|
#include "hw/irq.h"
|
|
#include "hw/register.h"
|
|
#include "qapi/error.h"
|
|
#include "qemu/bitops.h"
|
|
#include "qemu/log.h"
|
|
#include "qemu/cutils.h"
|
|
#include "qemu/event_notifier.h"
|
|
#include "hw/qdev-properties.h"
|
|
#include "qom/object_interfaces.h"
|
|
#include "migration/vmstate.h"
|
|
#include "hw/net/xlnx-versal-canfd.h"
|
|
#include "trace.h"
|
|
|
|
REG32(SOFTWARE_RESET_REGISTER, 0x0)
|
|
FIELD(SOFTWARE_RESET_REGISTER, CEN, 1, 1)
|
|
FIELD(SOFTWARE_RESET_REGISTER, SRST, 0, 1)
|
|
REG32(MODE_SELECT_REGISTER, 0x4)
|
|
FIELD(MODE_SELECT_REGISTER, ITO, 8, 8)
|
|
FIELD(MODE_SELECT_REGISTER, ABR, 7, 1)
|
|
FIELD(MODE_SELECT_REGISTER, SBR, 6, 1)
|
|
FIELD(MODE_SELECT_REGISTER, DPEE, 5, 1)
|
|
FIELD(MODE_SELECT_REGISTER, DAR, 4, 1)
|
|
FIELD(MODE_SELECT_REGISTER, BRSD, 3, 1)
|
|
FIELD(MODE_SELECT_REGISTER, SNOOP, 2, 1)
|
|
FIELD(MODE_SELECT_REGISTER, LBACK, 1, 1)
|
|
FIELD(MODE_SELECT_REGISTER, SLEEP, 0, 1)
|
|
REG32(ARBITRATION_PHASE_BAUD_RATE_PRESCALER_REGISTER, 0x8)
|
|
FIELD(ARBITRATION_PHASE_BAUD_RATE_PRESCALER_REGISTER, BRP, 0, 8)
|
|
REG32(ARBITRATION_PHASE_BIT_TIMING_REGISTER, 0xc)
|
|
FIELD(ARBITRATION_PHASE_BIT_TIMING_REGISTER, SJW, 16, 7)
|
|
FIELD(ARBITRATION_PHASE_BIT_TIMING_REGISTER, TS2, 8, 7)
|
|
FIELD(ARBITRATION_PHASE_BIT_TIMING_REGISTER, TS1, 0, 8)
|
|
REG32(ERROR_COUNTER_REGISTER, 0x10)
|
|
FIELD(ERROR_COUNTER_REGISTER, REC, 8, 8)
|
|
FIELD(ERROR_COUNTER_REGISTER, TEC, 0, 8)
|
|
REG32(ERROR_STATUS_REGISTER, 0x14)
|
|
FIELD(ERROR_STATUS_REGISTER, F_BERR, 11, 1)
|
|
FIELD(ERROR_STATUS_REGISTER, F_STER, 10, 1)
|
|
FIELD(ERROR_STATUS_REGISTER, F_FMER, 9, 1)
|
|
FIELD(ERROR_STATUS_REGISTER, F_CRCER, 8, 1)
|
|
FIELD(ERROR_STATUS_REGISTER, ACKER, 4, 1)
|
|
FIELD(ERROR_STATUS_REGISTER, BERR, 3, 1)
|
|
FIELD(ERROR_STATUS_REGISTER, STER, 2, 1)
|
|
FIELD(ERROR_STATUS_REGISTER, FMER, 1, 1)
|
|
FIELD(ERROR_STATUS_REGISTER, CRCER, 0, 1)
|
|
REG32(STATUS_REGISTER, 0x18)
|
|
FIELD(STATUS_REGISTER, TDCV, 16, 7)
|
|
FIELD(STATUS_REGISTER, SNOOP, 12, 1)
|
|
FIELD(STATUS_REGISTER, BSFR_CONFIG, 10, 1)
|
|
FIELD(STATUS_REGISTER, PEE_CONFIG, 9, 1)
|
|
FIELD(STATUS_REGISTER, ESTAT, 7, 2)
|
|
FIELD(STATUS_REGISTER, ERRWRN, 6, 1)
|
|
FIELD(STATUS_REGISTER, BBSY, 5, 1)
|
|
FIELD(STATUS_REGISTER, BIDLE, 4, 1)
|
|
FIELD(STATUS_REGISTER, NORMAL, 3, 1)
|
|
FIELD(STATUS_REGISTER, SLEEP, 2, 1)
|
|
FIELD(STATUS_REGISTER, LBACK, 1, 1)
|
|
FIELD(STATUS_REGISTER, CONFIG, 0, 1)
|
|
REG32(INTERRUPT_STATUS_REGISTER, 0x1c)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, TXEWMFLL, 31, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, TXEOFLW, 30, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, RXBOFLW_BI, 24, 6)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, RXLRM_BI, 18, 6)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, RXMNF, 17, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, RXFWMFLL_1, 16, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, RXFOFLW_1, 15, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, TXCRS, 14, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, TXRRS, 13, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, RXFWMFLL, 12, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, WKUP, 11, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, SLP, 10, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, BSOFF, 9, 1)
|
|
/*
|
|
* In the original HW description below bit is named as ERROR but an ERROR
|
|
* field name collides with a macro in Windows build. To avoid Windows build
|
|
* failures, the bit is renamed to ERROR_BIT.
|
|
*/
|
|
FIELD(INTERRUPT_STATUS_REGISTER, ERROR_BIT, 8, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, RXFOFLW, 6, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, TSCNT_OFLW, 5, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, RXOK, 4, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, BSFRD, 3, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, PEE, 2, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, TXOK, 1, 1)
|
|
FIELD(INTERRUPT_STATUS_REGISTER, ARBLST, 0, 1)
|
|
REG32(INTERRUPT_ENABLE_REGISTER, 0x20)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, ETXEWMFLL, 31, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, ETXEOFLW, 30, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, ERXMNF, 17, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, ERXFWMFLL_1, 16, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, ERXFOFLW_1, 15, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, ETXCRS, 14, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, ETXRRS, 13, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, ERXFWMFLL, 12, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, EWKUP, 11, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, ESLP, 10, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, EBSOFF, 9, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, EERROR, 8, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, ERFXOFLW, 6, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, ETSCNT_OFLW, 5, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, ERXOK, 4, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, EBSFRD, 3, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, EPEE, 2, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, ETXOK, 1, 1)
|
|
FIELD(INTERRUPT_ENABLE_REGISTER, EARBLOST, 0, 1)
|
|
REG32(INTERRUPT_CLEAR_REGISTER, 0x24)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CTXEWMFLL, 31, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CTXEOFLW, 30, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CRXMNF, 17, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CRXFWMFLL_1, 16, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CRXFOFLW_1, 15, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CTXCRS, 14, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CTXRRS, 13, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CRXFWMFLL, 12, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CWKUP, 11, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CSLP, 10, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CBSOFF, 9, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CERROR, 8, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CRFXOFLW, 6, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CTSCNT_OFLW, 5, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CRXOK, 4, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CBSFRD, 3, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CPEE, 2, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CTXOK, 1, 1)
|
|
FIELD(INTERRUPT_CLEAR_REGISTER, CARBLOST, 0, 1)
|
|
REG32(TIMESTAMP_REGISTER, 0x28)
|
|
FIELD(TIMESTAMP_REGISTER, TIMESTAMP_CNT, 16, 16)
|
|
FIELD(TIMESTAMP_REGISTER, CTS, 0, 1)
|
|
REG32(DATA_PHASE_BAUD_RATE_PRESCALER_REGISTER, 0x88)
|
|
FIELD(DATA_PHASE_BAUD_RATE_PRESCALER_REGISTER, TDC, 16, 1)
|
|
FIELD(DATA_PHASE_BAUD_RATE_PRESCALER_REGISTER, TDCOFF, 8, 6)
|
|
FIELD(DATA_PHASE_BAUD_RATE_PRESCALER_REGISTER, DP_BRP, 0, 8)
|
|
REG32(DATA_PHASE_BIT_TIMING_REGISTER, 0x8c)
|
|
FIELD(DATA_PHASE_BIT_TIMING_REGISTER, DP_SJW, 16, 4)
|
|
FIELD(DATA_PHASE_BIT_TIMING_REGISTER, DP_TS2, 8, 4)
|
|
FIELD(DATA_PHASE_BIT_TIMING_REGISTER, DP_TS1, 0, 5)
|
|
REG32(TX_BUFFER_READY_REQUEST_REGISTER, 0x90)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR31, 31, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR30, 30, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR29, 29, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR28, 28, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR27, 27, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR26, 26, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR25, 25, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR24, 24, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR23, 23, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR22, 22, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR21, 21, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR20, 20, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR19, 19, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR18, 18, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR17, 17, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR16, 16, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR15, 15, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR14, 14, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR13, 13, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR12, 12, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR11, 11, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR10, 10, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR9, 9, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR8, 8, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR7, 7, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR6, 6, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR5, 5, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR4, 4, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR3, 3, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR2, 2, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR1, 1, 1)
|
|
FIELD(TX_BUFFER_READY_REQUEST_REGISTER, RR0, 0, 1)
|
|
REG32(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, 0x94)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS31, 31, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS30, 30, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS29, 29, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS28, 28, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS27, 27, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS26, 26, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS25, 25, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS24, 24, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS23, 23, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS22, 22, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS21, 21, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS20, 20, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS19, 19, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS18, 18, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS17, 17, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS16, 16, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS15, 15, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS14, 14, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS13, 13, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS12, 12, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS11, 11, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS10, 10, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS9, 9, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS8, 8, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS7, 7, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS6, 6, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS5, 5, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS4, 4, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS3, 3, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS2, 2, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS1, 1, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER, ERRS0, 0, 1)
|
|
REG32(TX_BUFFER_CANCEL_REQUEST_REGISTER, 0x98)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR31, 31, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR30, 30, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR29, 29, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR28, 28, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR27, 27, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR26, 26, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR25, 25, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR24, 24, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR23, 23, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR22, 22, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR21, 21, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR20, 20, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR19, 19, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR18, 18, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR17, 17, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR16, 16, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR15, 15, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR14, 14, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR13, 13, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR12, 12, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR11, 11, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR10, 10, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR9, 9, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR8, 8, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR7, 7, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR6, 6, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR5, 5, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR4, 4, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR3, 3, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR2, 2, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR1, 1, 1)
|
|
FIELD(TX_BUFFER_CANCEL_REQUEST_REGISTER, CR0, 0, 1)
|
|
REG32(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, 0x9c)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS31, 31,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS30, 30,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS29, 29,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS28, 28,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS27, 27,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS26, 26,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS25, 25,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS24, 24,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS23, 23,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS22, 22,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS21, 21,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS20, 20,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS19, 19,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS18, 18,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS17, 17,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS16, 16,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS15, 15,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS14, 14,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS13, 13,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS12, 12,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS11, 11,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS10, 10,
|
|
1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS9, 9, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS8, 8, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS7, 7, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS6, 6, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS5, 5, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS4, 4, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS3, 3, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS2, 2, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS1, 1, 1)
|
|
FIELD(INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER, ECRS0, 0, 1)
|
|
REG32(TX_EVENT_FIFO_STATUS_REGISTER, 0xa0)
|
|
FIELD(TX_EVENT_FIFO_STATUS_REGISTER, TXE_FL, 8, 6)
|
|
FIELD(TX_EVENT_FIFO_STATUS_REGISTER, TXE_IRI, 7, 1)
|
|
FIELD(TX_EVENT_FIFO_STATUS_REGISTER, TXE_RI, 0, 5)
|
|
REG32(TX_EVENT_FIFO_WATERMARK_REGISTER, 0xa4)
|
|
FIELD(TX_EVENT_FIFO_WATERMARK_REGISTER, TXE_FWM, 0, 5)
|
|
REG32(ACCEPTANCE_FILTER_CONTROL_REGISTER, 0xe0)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF31, 31, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF30, 30, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF29, 29, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF28, 28, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF27, 27, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF26, 26, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF25, 25, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF24, 24, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF23, 23, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF22, 22, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF21, 21, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF20, 20, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF19, 19, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF18, 18, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF17, 17, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF16, 16, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF15, 15, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF14, 14, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF13, 13, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF12, 12, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF11, 11, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF10, 10, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF9, 9, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF8, 8, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF7, 7, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF6, 6, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF5, 5, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF4, 4, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF3, 3, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF2, 2, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF1, 1, 1)
|
|
FIELD(ACCEPTANCE_FILTER_CONTROL_REGISTER, UAF0, 0, 1)
|
|
REG32(RX_FIFO_STATUS_REGISTER, 0xe8)
|
|
FIELD(RX_FIFO_STATUS_REGISTER, FL_1, 24, 7)
|
|
FIELD(RX_FIFO_STATUS_REGISTER, IRI_1, 23, 1)
|
|
FIELD(RX_FIFO_STATUS_REGISTER, RI_1, 16, 6)
|
|
FIELD(RX_FIFO_STATUS_REGISTER, FL, 8, 7)
|
|
FIELD(RX_FIFO_STATUS_REGISTER, IRI, 7, 1)
|
|
FIELD(RX_FIFO_STATUS_REGISTER, RI, 0, 6)
|
|
REG32(RX_FIFO_WATERMARK_REGISTER, 0xec)
|
|
FIELD(RX_FIFO_WATERMARK_REGISTER, RXFP, 16, 5)
|
|
FIELD(RX_FIFO_WATERMARK_REGISTER, RXFWM_1, 8, 6)
|
|
FIELD(RX_FIFO_WATERMARK_REGISTER, RXFWM, 0, 6)
|
|
REG32(TB_ID_REGISTER, 0x100)
|
|
FIELD(TB_ID_REGISTER, ID, 21, 11)
|
|
FIELD(TB_ID_REGISTER, SRR_RTR_RRS, 20, 1)
|
|
FIELD(TB_ID_REGISTER, IDE, 19, 1)
|
|
FIELD(TB_ID_REGISTER, ID_EXT, 1, 18)
|
|
FIELD(TB_ID_REGISTER, RTR_RRS, 0, 1)
|
|
REG32(TB0_DLC_REGISTER, 0x104)
|
|
FIELD(TB0_DLC_REGISTER, DLC, 28, 4)
|
|
FIELD(TB0_DLC_REGISTER, FDF, 27, 1)
|
|
FIELD(TB0_DLC_REGISTER, BRS, 26, 1)
|
|
FIELD(TB0_DLC_REGISTER, RSVD2, 25, 1)
|
|
FIELD(TB0_DLC_REGISTER, EFC, 24, 1)
|
|
FIELD(TB0_DLC_REGISTER, MM, 16, 8)
|
|
FIELD(TB0_DLC_REGISTER, RSVD1, 0, 16)
|
|
REG32(TB_DW0_REGISTER, 0x108)
|
|
FIELD(TB_DW0_REGISTER, DATA_BYTES0, 24, 8)
|
|
FIELD(TB_DW0_REGISTER, DATA_BYTES1, 16, 8)
|
|
FIELD(TB_DW0_REGISTER, DATA_BYTES2, 8, 8)
|
|
FIELD(TB_DW0_REGISTER, DATA_BYTES3, 0, 8)
|
|
REG32(TB_DW1_REGISTER, 0x10c)
|
|
FIELD(TB_DW1_REGISTER, DATA_BYTES4, 24, 8)
|
|
FIELD(TB_DW1_REGISTER, DATA_BYTES5, 16, 8)
|
|
FIELD(TB_DW1_REGISTER, DATA_BYTES6, 8, 8)
|
|
FIELD(TB_DW1_REGISTER, DATA_BYTES7, 0, 8)
|
|
REG32(TB_DW2_REGISTER, 0x110)
|
|
FIELD(TB_DW2_REGISTER, DATA_BYTES8, 24, 8)
|
|
FIELD(TB_DW2_REGISTER, DATA_BYTES9, 16, 8)
|
|
FIELD(TB_DW2_REGISTER, DATA_BYTES10, 8, 8)
|
|
FIELD(TB_DW2_REGISTER, DATA_BYTES11, 0, 8)
|
|
REG32(TB_DW3_REGISTER, 0x114)
|
|
FIELD(TB_DW3_REGISTER, DATA_BYTES12, 24, 8)
|
|
FIELD(TB_DW3_REGISTER, DATA_BYTES13, 16, 8)
|
|
FIELD(TB_DW3_REGISTER, DATA_BYTES14, 8, 8)
|
|
FIELD(TB_DW3_REGISTER, DATA_BYTES15, 0, 8)
|
|
REG32(TB_DW4_REGISTER, 0x118)
|
|
FIELD(TB_DW4_REGISTER, DATA_BYTES16, 24, 8)
|
|
FIELD(TB_DW4_REGISTER, DATA_BYTES17, 16, 8)
|
|
FIELD(TB_DW4_REGISTER, DATA_BYTES18, 8, 8)
|
|
FIELD(TB_DW4_REGISTER, DATA_BYTES19, 0, 8)
|
|
REG32(TB_DW5_REGISTER, 0x11c)
|
|
FIELD(TB_DW5_REGISTER, DATA_BYTES20, 24, 8)
|
|
FIELD(TB_DW5_REGISTER, DATA_BYTES21, 16, 8)
|
|
FIELD(TB_DW5_REGISTER, DATA_BYTES22, 8, 8)
|
|
FIELD(TB_DW5_REGISTER, DATA_BYTES23, 0, 8)
|
|
REG32(TB_DW6_REGISTER, 0x120)
|
|
FIELD(TB_DW6_REGISTER, DATA_BYTES24, 24, 8)
|
|
FIELD(TB_DW6_REGISTER, DATA_BYTES25, 16, 8)
|
|
FIELD(TB_DW6_REGISTER, DATA_BYTES26, 8, 8)
|
|
FIELD(TB_DW6_REGISTER, DATA_BYTES27, 0, 8)
|
|
REG32(TB_DW7_REGISTER, 0x124)
|
|
FIELD(TB_DW7_REGISTER, DATA_BYTES28, 24, 8)
|
|
FIELD(TB_DW7_REGISTER, DATA_BYTES29, 16, 8)
|
|
FIELD(TB_DW7_REGISTER, DATA_BYTES30, 8, 8)
|
|
FIELD(TB_DW7_REGISTER, DATA_BYTES31, 0, 8)
|
|
REG32(TB_DW8_REGISTER, 0x128)
|
|
FIELD(TB_DW8_REGISTER, DATA_BYTES32, 24, 8)
|
|
FIELD(TB_DW8_REGISTER, DATA_BYTES33, 16, 8)
|
|
FIELD(TB_DW8_REGISTER, DATA_BYTES34, 8, 8)
|
|
FIELD(TB_DW8_REGISTER, DATA_BYTES35, 0, 8)
|
|
REG32(TB_DW9_REGISTER, 0x12c)
|
|
FIELD(TB_DW9_REGISTER, DATA_BYTES36, 24, 8)
|
|
FIELD(TB_DW9_REGISTER, DATA_BYTES37, 16, 8)
|
|
FIELD(TB_DW9_REGISTER, DATA_BYTES38, 8, 8)
|
|
FIELD(TB_DW9_REGISTER, DATA_BYTES39, 0, 8)
|
|
REG32(TB_DW10_REGISTER, 0x130)
|
|
FIELD(TB_DW10_REGISTER, DATA_BYTES40, 24, 8)
|
|
FIELD(TB_DW10_REGISTER, DATA_BYTES41, 16, 8)
|
|
FIELD(TB_DW10_REGISTER, DATA_BYTES42, 8, 8)
|
|
FIELD(TB_DW10_REGISTER, DATA_BYTES43, 0, 8)
|
|
REG32(TB_DW11_REGISTER, 0x134)
|
|
FIELD(TB_DW11_REGISTER, DATA_BYTES44, 24, 8)
|
|
FIELD(TB_DW11_REGISTER, DATA_BYTES45, 16, 8)
|
|
FIELD(TB_DW11_REGISTER, DATA_BYTES46, 8, 8)
|
|
FIELD(TB_DW11_REGISTER, DATA_BYTES47, 0, 8)
|
|
REG32(TB_DW12_REGISTER, 0x138)
|
|
FIELD(TB_DW12_REGISTER, DATA_BYTES48, 24, 8)
|
|
FIELD(TB_DW12_REGISTER, DATA_BYTES49, 16, 8)
|
|
FIELD(TB_DW12_REGISTER, DATA_BYTES50, 8, 8)
|
|
FIELD(TB_DW12_REGISTER, DATA_BYTES51, 0, 8)
|
|
REG32(TB_DW13_REGISTER, 0x13c)
|
|
FIELD(TB_DW13_REGISTER, DATA_BYTES52, 24, 8)
|
|
FIELD(TB_DW13_REGISTER, DATA_BYTES53, 16, 8)
|
|
FIELD(TB_DW13_REGISTER, DATA_BYTES54, 8, 8)
|
|
FIELD(TB_DW13_REGISTER, DATA_BYTES55, 0, 8)
|
|
REG32(TB_DW14_REGISTER, 0x140)
|
|
FIELD(TB_DW14_REGISTER, DATA_BYTES56, 24, 8)
|
|
FIELD(TB_DW14_REGISTER, DATA_BYTES57, 16, 8)
|
|
FIELD(TB_DW14_REGISTER, DATA_BYTES58, 8, 8)
|
|
FIELD(TB_DW14_REGISTER, DATA_BYTES59, 0, 8)
|
|
REG32(TB_DW15_REGISTER, 0x144)
|
|
FIELD(TB_DW15_REGISTER, DATA_BYTES60, 24, 8)
|
|
FIELD(TB_DW15_REGISTER, DATA_BYTES61, 16, 8)
|
|
FIELD(TB_DW15_REGISTER, DATA_BYTES62, 8, 8)
|
|
FIELD(TB_DW15_REGISTER, DATA_BYTES63, 0, 8)
|
|
REG32(AFMR_REGISTER, 0xa00)
|
|
FIELD(AFMR_REGISTER, AMID, 21, 11)
|
|
FIELD(AFMR_REGISTER, AMSRR, 20, 1)
|
|
FIELD(AFMR_REGISTER, AMIDE, 19, 1)
|
|
FIELD(AFMR_REGISTER, AMID_EXT, 1, 18)
|
|
FIELD(AFMR_REGISTER, AMRTR, 0, 1)
|
|
REG32(AFIR_REGISTER, 0xa04)
|
|
FIELD(AFIR_REGISTER, AIID, 21, 11)
|
|
FIELD(AFIR_REGISTER, AISRR, 20, 1)
|
|
FIELD(AFIR_REGISTER, AIIDE, 19, 1)
|
|
FIELD(AFIR_REGISTER, AIID_EXT, 1, 18)
|
|
FIELD(AFIR_REGISTER, AIRTR, 0, 1)
|
|
REG32(TXE_FIFO_TB_ID_REGISTER, 0x2000)
|
|
FIELD(TXE_FIFO_TB_ID_REGISTER, ID, 21, 11)
|
|
FIELD(TXE_FIFO_TB_ID_REGISTER, SRR_RTR_RRS, 20, 1)
|
|
FIELD(TXE_FIFO_TB_ID_REGISTER, IDE, 19, 1)
|
|
FIELD(TXE_FIFO_TB_ID_REGISTER, ID_EXT, 1, 18)
|
|
FIELD(TXE_FIFO_TB_ID_REGISTER, RTR_RRS, 0, 1)
|
|
REG32(TXE_FIFO_TB_DLC_REGISTER, 0x2004)
|
|
FIELD(TXE_FIFO_TB_DLC_REGISTER, DLC, 28, 4)
|
|
FIELD(TXE_FIFO_TB_DLC_REGISTER, FDF, 27, 1)
|
|
FIELD(TXE_FIFO_TB_DLC_REGISTER, BRS, 26, 1)
|
|
FIELD(TXE_FIFO_TB_DLC_REGISTER, ET, 24, 2)
|
|
FIELD(TXE_FIFO_TB_DLC_REGISTER, MM, 16, 8)
|
|
FIELD(TXE_FIFO_TB_DLC_REGISTER, TIMESTAMP, 0, 16)
|
|
REG32(RB_ID_REGISTER, 0x2100)
|
|
FIELD(RB_ID_REGISTER, ID, 21, 11)
|
|
FIELD(RB_ID_REGISTER, SRR_RTR_RRS, 20, 1)
|
|
FIELD(RB_ID_REGISTER, IDE, 19, 1)
|
|
FIELD(RB_ID_REGISTER, ID_EXT, 1, 18)
|
|
FIELD(RB_ID_REGISTER, RTR_RRS, 0, 1)
|
|
REG32(RB_DLC_REGISTER, 0x2104)
|
|
FIELD(RB_DLC_REGISTER, DLC, 28, 4)
|
|
FIELD(RB_DLC_REGISTER, FDF, 27, 1)
|
|
FIELD(RB_DLC_REGISTER, BRS, 26, 1)
|
|
FIELD(RB_DLC_REGISTER, ESI, 25, 1)
|
|
FIELD(RB_DLC_REGISTER, MATCHED_FILTER_INDEX, 16, 5)
|
|
FIELD(RB_DLC_REGISTER, TIMESTAMP, 0, 16)
|
|
REG32(RB_DW0_REGISTER, 0x2108)
|
|
FIELD(RB_DW0_REGISTER, DATA_BYTES0, 24, 8)
|
|
FIELD(RB_DW0_REGISTER, DATA_BYTES1, 16, 8)
|
|
FIELD(RB_DW0_REGISTER, DATA_BYTES2, 8, 8)
|
|
FIELD(RB_DW0_REGISTER, DATA_BYTES3, 0, 8)
|
|
REG32(RB_DW1_REGISTER, 0x210c)
|
|
FIELD(RB_DW1_REGISTER, DATA_BYTES4, 24, 8)
|
|
FIELD(RB_DW1_REGISTER, DATA_BYTES5, 16, 8)
|
|
FIELD(RB_DW1_REGISTER, DATA_BYTES6, 8, 8)
|
|
FIELD(RB_DW1_REGISTER, DATA_BYTES7, 0, 8)
|
|
REG32(RB_DW2_REGISTER, 0x2110)
|
|
FIELD(RB_DW2_REGISTER, DATA_BYTES8, 24, 8)
|
|
FIELD(RB_DW2_REGISTER, DATA_BYTES9, 16, 8)
|
|
FIELD(RB_DW2_REGISTER, DATA_BYTES10, 8, 8)
|
|
FIELD(RB_DW2_REGISTER, DATA_BYTES11, 0, 8)
|
|
REG32(RB_DW3_REGISTER, 0x2114)
|
|
FIELD(RB_DW3_REGISTER, DATA_BYTES12, 24, 8)
|
|
FIELD(RB_DW3_REGISTER, DATA_BYTES13, 16, 8)
|
|
FIELD(RB_DW3_REGISTER, DATA_BYTES14, 8, 8)
|
|
FIELD(RB_DW3_REGISTER, DATA_BYTES15, 0, 8)
|
|
REG32(RB_DW4_REGISTER, 0x2118)
|
|
FIELD(RB_DW4_REGISTER, DATA_BYTES16, 24, 8)
|
|
FIELD(RB_DW4_REGISTER, DATA_BYTES17, 16, 8)
|
|
FIELD(RB_DW4_REGISTER, DATA_BYTES18, 8, 8)
|
|
FIELD(RB_DW4_REGISTER, DATA_BYTES19, 0, 8)
|
|
REG32(RB_DW5_REGISTER, 0x211c)
|
|
FIELD(RB_DW5_REGISTER, DATA_BYTES20, 24, 8)
|
|
FIELD(RB_DW5_REGISTER, DATA_BYTES21, 16, 8)
|
|
FIELD(RB_DW5_REGISTER, DATA_BYTES22, 8, 8)
|
|
FIELD(RB_DW5_REGISTER, DATA_BYTES23, 0, 8)
|
|
REG32(RB_DW6_REGISTER, 0x2120)
|
|
FIELD(RB_DW6_REGISTER, DATA_BYTES24, 24, 8)
|
|
FIELD(RB_DW6_REGISTER, DATA_BYTES25, 16, 8)
|
|
FIELD(RB_DW6_REGISTER, DATA_BYTES26, 8, 8)
|
|
FIELD(RB_DW6_REGISTER, DATA_BYTES27, 0, 8)
|
|
REG32(RB_DW7_REGISTER, 0x2124)
|
|
FIELD(RB_DW7_REGISTER, DATA_BYTES28, 24, 8)
|
|
FIELD(RB_DW7_REGISTER, DATA_BYTES29, 16, 8)
|
|
FIELD(RB_DW7_REGISTER, DATA_BYTES30, 8, 8)
|
|
FIELD(RB_DW7_REGISTER, DATA_BYTES31, 0, 8)
|
|
REG32(RB_DW8_REGISTER, 0x2128)
|
|
FIELD(RB_DW8_REGISTER, DATA_BYTES32, 24, 8)
|
|
FIELD(RB_DW8_REGISTER, DATA_BYTES33, 16, 8)
|
|
FIELD(RB_DW8_REGISTER, DATA_BYTES34, 8, 8)
|
|
FIELD(RB_DW8_REGISTER, DATA_BYTES35, 0, 8)
|
|
REG32(RB_DW9_REGISTER, 0x212c)
|
|
FIELD(RB_DW9_REGISTER, DATA_BYTES36, 24, 8)
|
|
FIELD(RB_DW9_REGISTER, DATA_BYTES37, 16, 8)
|
|
FIELD(RB_DW9_REGISTER, DATA_BYTES38, 8, 8)
|
|
FIELD(RB_DW9_REGISTER, DATA_BYTES39, 0, 8)
|
|
REG32(RB_DW10_REGISTER, 0x2130)
|
|
FIELD(RB_DW10_REGISTER, DATA_BYTES40, 24, 8)
|
|
FIELD(RB_DW10_REGISTER, DATA_BYTES41, 16, 8)
|
|
FIELD(RB_DW10_REGISTER, DATA_BYTES42, 8, 8)
|
|
FIELD(RB_DW10_REGISTER, DATA_BYTES43, 0, 8)
|
|
REG32(RB_DW11_REGISTER, 0x2134)
|
|
FIELD(RB_DW11_REGISTER, DATA_BYTES44, 24, 8)
|
|
FIELD(RB_DW11_REGISTER, DATA_BYTES45, 16, 8)
|
|
FIELD(RB_DW11_REGISTER, DATA_BYTES46, 8, 8)
|
|
FIELD(RB_DW11_REGISTER, DATA_BYTES47, 0, 8)
|
|
REG32(RB_DW12_REGISTER, 0x2138)
|
|
FIELD(RB_DW12_REGISTER, DATA_BYTES48, 24, 8)
|
|
FIELD(RB_DW12_REGISTER, DATA_BYTES49, 16, 8)
|
|
FIELD(RB_DW12_REGISTER, DATA_BYTES50, 8, 8)
|
|
FIELD(RB_DW12_REGISTER, DATA_BYTES51, 0, 8)
|
|
REG32(RB_DW13_REGISTER, 0x213c)
|
|
FIELD(RB_DW13_REGISTER, DATA_BYTES52, 24, 8)
|
|
FIELD(RB_DW13_REGISTER, DATA_BYTES53, 16, 8)
|
|
FIELD(RB_DW13_REGISTER, DATA_BYTES54, 8, 8)
|
|
FIELD(RB_DW13_REGISTER, DATA_BYTES55, 0, 8)
|
|
REG32(RB_DW14_REGISTER, 0x2140)
|
|
FIELD(RB_DW14_REGISTER, DATA_BYTES56, 24, 8)
|
|
FIELD(RB_DW14_REGISTER, DATA_BYTES57, 16, 8)
|
|
FIELD(RB_DW14_REGISTER, DATA_BYTES58, 8, 8)
|
|
FIELD(RB_DW14_REGISTER, DATA_BYTES59, 0, 8)
|
|
REG32(RB_DW15_REGISTER, 0x2144)
|
|
FIELD(RB_DW15_REGISTER, DATA_BYTES60, 24, 8)
|
|
FIELD(RB_DW15_REGISTER, DATA_BYTES61, 16, 8)
|
|
FIELD(RB_DW15_REGISTER, DATA_BYTES62, 8, 8)
|
|
FIELD(RB_DW15_REGISTER, DATA_BYTES63, 0, 8)
|
|
REG32(RB_ID_REGISTER_1, 0x4100)
|
|
FIELD(RB_ID_REGISTER_1, ID, 21, 11)
|
|
FIELD(RB_ID_REGISTER_1, SRR_RTR_RRS, 20, 1)
|
|
FIELD(RB_ID_REGISTER_1, IDE, 19, 1)
|
|
FIELD(RB_ID_REGISTER_1, ID_EXT, 1, 18)
|
|
FIELD(RB_ID_REGISTER_1, RTR_RRS, 0, 1)
|
|
REG32(RB_DLC_REGISTER_1, 0x4104)
|
|
FIELD(RB_DLC_REGISTER_1, DLC, 28, 4)
|
|
FIELD(RB_DLC_REGISTER_1, FDF, 27, 1)
|
|
FIELD(RB_DLC_REGISTER_1, BRS, 26, 1)
|
|
FIELD(RB_DLC_REGISTER_1, ESI, 25, 1)
|
|
FIELD(RB_DLC_REGISTER_1, MATCHED_FILTER_INDEX, 16, 5)
|
|
FIELD(RB_DLC_REGISTER_1, TIMESTAMP, 0, 16)
|
|
REG32(RB0_DW0_REGISTER_1, 0x4108)
|
|
FIELD(RB0_DW0_REGISTER_1, DATA_BYTES0, 24, 8)
|
|
FIELD(RB0_DW0_REGISTER_1, DATA_BYTES1, 16, 8)
|
|
FIELD(RB0_DW0_REGISTER_1, DATA_BYTES2, 8, 8)
|
|
FIELD(RB0_DW0_REGISTER_1, DATA_BYTES3, 0, 8)
|
|
REG32(RB_DW1_REGISTER_1, 0x410c)
|
|
FIELD(RB_DW1_REGISTER_1, DATA_BYTES4, 24, 8)
|
|
FIELD(RB_DW1_REGISTER_1, DATA_BYTES5, 16, 8)
|
|
FIELD(RB_DW1_REGISTER_1, DATA_BYTES6, 8, 8)
|
|
FIELD(RB_DW1_REGISTER_1, DATA_BYTES7, 0, 8)
|
|
REG32(RB_DW2_REGISTER_1, 0x4110)
|
|
FIELD(RB_DW2_REGISTER_1, DATA_BYTES8, 24, 8)
|
|
FIELD(RB_DW2_REGISTER_1, DATA_BYTES9, 16, 8)
|
|
FIELD(RB_DW2_REGISTER_1, DATA_BYTES10, 8, 8)
|
|
FIELD(RB_DW2_REGISTER_1, DATA_BYTES11, 0, 8)
|
|
REG32(RB_DW3_REGISTER_1, 0x4114)
|
|
FIELD(RB_DW3_REGISTER_1, DATA_BYTES12, 24, 8)
|
|
FIELD(RB_DW3_REGISTER_1, DATA_BYTES13, 16, 8)
|
|
FIELD(RB_DW3_REGISTER_1, DATA_BYTES14, 8, 8)
|
|
FIELD(RB_DW3_REGISTER_1, DATA_BYTES15, 0, 8)
|
|
REG32(RB_DW4_REGISTER_1, 0x4118)
|
|
FIELD(RB_DW4_REGISTER_1, DATA_BYTES16, 24, 8)
|
|
FIELD(RB_DW4_REGISTER_1, DATA_BYTES17, 16, 8)
|
|
FIELD(RB_DW4_REGISTER_1, DATA_BYTES18, 8, 8)
|
|
FIELD(RB_DW4_REGISTER_1, DATA_BYTES19, 0, 8)
|
|
REG32(RB_DW5_REGISTER_1, 0x411c)
|
|
FIELD(RB_DW5_REGISTER_1, DATA_BYTES20, 24, 8)
|
|
FIELD(RB_DW5_REGISTER_1, DATA_BYTES21, 16, 8)
|
|
FIELD(RB_DW5_REGISTER_1, DATA_BYTES22, 8, 8)
|
|
FIELD(RB_DW5_REGISTER_1, DATA_BYTES23, 0, 8)
|
|
REG32(RB_DW6_REGISTER_1, 0x4120)
|
|
FIELD(RB_DW6_REGISTER_1, DATA_BYTES24, 24, 8)
|
|
FIELD(RB_DW6_REGISTER_1, DATA_BYTES25, 16, 8)
|
|
FIELD(RB_DW6_REGISTER_1, DATA_BYTES26, 8, 8)
|
|
FIELD(RB_DW6_REGISTER_1, DATA_BYTES27, 0, 8)
|
|
REG32(RB_DW7_REGISTER_1, 0x4124)
|
|
FIELD(RB_DW7_REGISTER_1, DATA_BYTES28, 24, 8)
|
|
FIELD(RB_DW7_REGISTER_1, DATA_BYTES29, 16, 8)
|
|
FIELD(RB_DW7_REGISTER_1, DATA_BYTES30, 8, 8)
|
|
FIELD(RB_DW7_REGISTER_1, DATA_BYTES31, 0, 8)
|
|
REG32(RB_DW8_REGISTER_1, 0x4128)
|
|
FIELD(RB_DW8_REGISTER_1, DATA_BYTES32, 24, 8)
|
|
FIELD(RB_DW8_REGISTER_1, DATA_BYTES33, 16, 8)
|
|
FIELD(RB_DW8_REGISTER_1, DATA_BYTES34, 8, 8)
|
|
FIELD(RB_DW8_REGISTER_1, DATA_BYTES35, 0, 8)
|
|
REG32(RB_DW9_REGISTER_1, 0x412c)
|
|
FIELD(RB_DW9_REGISTER_1, DATA_BYTES36, 24, 8)
|
|
FIELD(RB_DW9_REGISTER_1, DATA_BYTES37, 16, 8)
|
|
FIELD(RB_DW9_REGISTER_1, DATA_BYTES38, 8, 8)
|
|
FIELD(RB_DW9_REGISTER_1, DATA_BYTES39, 0, 8)
|
|
REG32(RB_DW10_REGISTER_1, 0x4130)
|
|
FIELD(RB_DW10_REGISTER_1, DATA_BYTES40, 24, 8)
|
|
FIELD(RB_DW10_REGISTER_1, DATA_BYTES41, 16, 8)
|
|
FIELD(RB_DW10_REGISTER_1, DATA_BYTES42, 8, 8)
|
|
FIELD(RB_DW10_REGISTER_1, DATA_BYTES43, 0, 8)
|
|
REG32(RB_DW11_REGISTER_1, 0x4134)
|
|
FIELD(RB_DW11_REGISTER_1, DATA_BYTES44, 24, 8)
|
|
FIELD(RB_DW11_REGISTER_1, DATA_BYTES45, 16, 8)
|
|
FIELD(RB_DW11_REGISTER_1, DATA_BYTES46, 8, 8)
|
|
FIELD(RB_DW11_REGISTER_1, DATA_BYTES47, 0, 8)
|
|
REG32(RB_DW12_REGISTER_1, 0x4138)
|
|
FIELD(RB_DW12_REGISTER_1, DATA_BYTES48, 24, 8)
|
|
FIELD(RB_DW12_REGISTER_1, DATA_BYTES49, 16, 8)
|
|
FIELD(RB_DW12_REGISTER_1, DATA_BYTES50, 8, 8)
|
|
FIELD(RB_DW12_REGISTER_1, DATA_BYTES51, 0, 8)
|
|
REG32(RB_DW13_REGISTER_1, 0x413c)
|
|
FIELD(RB_DW13_REGISTER_1, DATA_BYTES52, 24, 8)
|
|
FIELD(RB_DW13_REGISTER_1, DATA_BYTES53, 16, 8)
|
|
FIELD(RB_DW13_REGISTER_1, DATA_BYTES54, 8, 8)
|
|
FIELD(RB_DW13_REGISTER_1, DATA_BYTES55, 0, 8)
|
|
REG32(RB_DW14_REGISTER_1, 0x4140)
|
|
FIELD(RB_DW14_REGISTER_1, DATA_BYTES56, 24, 8)
|
|
FIELD(RB_DW14_REGISTER_1, DATA_BYTES57, 16, 8)
|
|
FIELD(RB_DW14_REGISTER_1, DATA_BYTES58, 8, 8)
|
|
FIELD(RB_DW14_REGISTER_1, DATA_BYTES59, 0, 8)
|
|
REG32(RB_DW15_REGISTER_1, 0x4144)
|
|
FIELD(RB_DW15_REGISTER_1, DATA_BYTES60, 24, 8)
|
|
FIELD(RB_DW15_REGISTER_1, DATA_BYTES61, 16, 8)
|
|
FIELD(RB_DW15_REGISTER_1, DATA_BYTES62, 8, 8)
|
|
FIELD(RB_DW15_REGISTER_1, DATA_BYTES63, 0, 8)
|
|
|
|
static uint8_t canfd_dlc_array[8] = {8, 12, 16, 20, 24, 32, 48, 64};
|
|
|
|
static void canfd_update_irq(XlnxVersalCANFDState *s)
|
|
{
|
|
unsigned int irq = s->regs[R_INTERRUPT_STATUS_REGISTER] &
|
|
s->regs[R_INTERRUPT_ENABLE_REGISTER];
|
|
g_autofree char *path = object_get_canonical_path(OBJECT(s));
|
|
|
|
/* RX watermark interrupts. */
|
|
if (ARRAY_FIELD_EX32(s->regs, RX_FIFO_STATUS_REGISTER, FL) >
|
|
ARRAY_FIELD_EX32(s->regs, RX_FIFO_WATERMARK_REGISTER, RXFWM)) {
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, RXFWMFLL, 1);
|
|
}
|
|
|
|
if (ARRAY_FIELD_EX32(s->regs, RX_FIFO_STATUS_REGISTER, FL_1) >
|
|
ARRAY_FIELD_EX32(s->regs, RX_FIFO_WATERMARK_REGISTER, RXFWM_1)) {
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, RXFWMFLL_1, 1);
|
|
}
|
|
|
|
/* TX watermark interrupt. */
|
|
if (ARRAY_FIELD_EX32(s->regs, TX_EVENT_FIFO_STATUS_REGISTER, TXE_FL) >
|
|
ARRAY_FIELD_EX32(s->regs, TX_EVENT_FIFO_WATERMARK_REGISTER, TXE_FWM)) {
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, TXEWMFLL, 1);
|
|
}
|
|
|
|
trace_xlnx_canfd_update_irq(path, s->regs[R_INTERRUPT_STATUS_REGISTER],
|
|
s->regs[R_INTERRUPT_ENABLE_REGISTER], irq);
|
|
|
|
qemu_set_irq(s->irq_canfd_int, irq);
|
|
}
|
|
|
|
static void canfd_ier_post_write(RegisterInfo *reg, uint64_t val64)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(reg->opaque);
|
|
|
|
canfd_update_irq(s);
|
|
}
|
|
|
|
static uint64_t canfd_icr_pre_write(RegisterInfo *reg, uint64_t val64)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(reg->opaque);
|
|
uint32_t val = val64;
|
|
|
|
s->regs[R_INTERRUPT_STATUS_REGISTER] &= ~val;
|
|
|
|
/*
|
|
* RXBOFLW_BI field is automatically cleared to default if RXBOFLW bit is
|
|
* cleared in ISR.
|
|
*/
|
|
if (ARRAY_FIELD_EX32(s->regs, INTERRUPT_STATUS_REGISTER, RXFWMFLL_1)) {
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, RXBOFLW_BI, 0);
|
|
}
|
|
|
|
canfd_update_irq(s);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void canfd_config_reset(XlnxVersalCANFDState *s)
|
|
{
|
|
|
|
unsigned int i;
|
|
|
|
/* Reset all the configuration registers. */
|
|
for (i = 0; i < R_RX_FIFO_WATERMARK_REGISTER; ++i) {
|
|
register_reset(&s->reg_info[i]);
|
|
}
|
|
|
|
canfd_update_irq(s);
|
|
}
|
|
|
|
static void canfd_config_mode(XlnxVersalCANFDState *s)
|
|
{
|
|
register_reset(&s->reg_info[R_ERROR_COUNTER_REGISTER]);
|
|
register_reset(&s->reg_info[R_ERROR_STATUS_REGISTER]);
|
|
register_reset(&s->reg_info[R_STATUS_REGISTER]);
|
|
|
|
/* Put XlnxVersalCANFDState in configuration mode. */
|
|
ARRAY_FIELD_DP32(s->regs, STATUS_REGISTER, CONFIG, 1);
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, WKUP, 0);
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, SLP, 0);
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, BSOFF, 0);
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, ERROR_BIT, 0);
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, RXFOFLW, 0);
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, RXFOFLW_1, 0);
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, RXOK, 0);
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, TXOK, 0);
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, ARBLST, 0);
|
|
|
|
/* Clear the time stamp. */
|
|
ptimer_transaction_begin(s->canfd_timer);
|
|
ptimer_set_count(s->canfd_timer, 0);
|
|
ptimer_transaction_commit(s->canfd_timer);
|
|
|
|
canfd_update_irq(s);
|
|
}
|
|
|
|
static void update_status_register_mode_bits(XlnxVersalCANFDState *s)
|
|
{
|
|
bool sleep_status = ARRAY_FIELD_EX32(s->regs, STATUS_REGISTER, SLEEP);
|
|
bool sleep_mode = ARRAY_FIELD_EX32(s->regs, MODE_SELECT_REGISTER, SLEEP);
|
|
/* Wake up interrupt bit. */
|
|
bool wakeup_irq_val = !sleep_mode && sleep_status;
|
|
/* Sleep interrupt bit. */
|
|
bool sleep_irq_val = sleep_mode && !sleep_status;
|
|
|
|
/* Clear previous core mode status bits. */
|
|
ARRAY_FIELD_DP32(s->regs, STATUS_REGISTER, LBACK, 0);
|
|
ARRAY_FIELD_DP32(s->regs, STATUS_REGISTER, SLEEP, 0);
|
|
ARRAY_FIELD_DP32(s->regs, STATUS_REGISTER, SNOOP, 0);
|
|
ARRAY_FIELD_DP32(s->regs, STATUS_REGISTER, NORMAL, 0);
|
|
|
|
/* set current mode bit and generate irqs accordingly. */
|
|
if (ARRAY_FIELD_EX32(s->regs, MODE_SELECT_REGISTER, LBACK)) {
|
|
ARRAY_FIELD_DP32(s->regs, STATUS_REGISTER, LBACK, 1);
|
|
} else if (ARRAY_FIELD_EX32(s->regs, MODE_SELECT_REGISTER, SLEEP)) {
|
|
ARRAY_FIELD_DP32(s->regs, STATUS_REGISTER, SLEEP, 1);
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, SLP,
|
|
sleep_irq_val);
|
|
} else if (ARRAY_FIELD_EX32(s->regs, MODE_SELECT_REGISTER, SNOOP)) {
|
|
ARRAY_FIELD_DP32(s->regs, STATUS_REGISTER, SNOOP, 1);
|
|
} else {
|
|
/* If all bits are zero, XlnxVersalCANFDState is set in normal mode. */
|
|
ARRAY_FIELD_DP32(s->regs, STATUS_REGISTER, NORMAL, 1);
|
|
/* Set wakeup interrupt bit. */
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, WKUP,
|
|
wakeup_irq_val);
|
|
}
|
|
|
|
/* Put the CANFD in error active state. */
|
|
ARRAY_FIELD_DP32(s->regs, STATUS_REGISTER, ESTAT, 1);
|
|
|
|
canfd_update_irq(s);
|
|
}
|
|
|
|
static uint64_t canfd_msr_pre_write(RegisterInfo *reg, uint64_t val64)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(reg->opaque);
|
|
uint32_t val = val64;
|
|
uint8_t multi_mode = 0;
|
|
|
|
/*
|
|
* Multiple mode set check. This is done to make sure user doesn't set
|
|
* multiple modes.
|
|
*/
|
|
multi_mode = FIELD_EX32(val, MODE_SELECT_REGISTER, LBACK) +
|
|
FIELD_EX32(val, MODE_SELECT_REGISTER, SLEEP) +
|
|
FIELD_EX32(val, MODE_SELECT_REGISTER, SNOOP);
|
|
|
|
if (multi_mode > 1) {
|
|
qemu_log_mask(LOG_GUEST_ERROR, "Attempting to configure several modes"
|
|
" simultaneously. One mode will be selected according to"
|
|
" their priority: LBACK > SLEEP > SNOOP.\n");
|
|
}
|
|
|
|
if (ARRAY_FIELD_EX32(s->regs, SOFTWARE_RESET_REGISTER, CEN) == 0) {
|
|
/* In configuration mode, any mode can be selected. */
|
|
s->regs[R_MODE_SELECT_REGISTER] = val;
|
|
} else {
|
|
bool sleep_mode_bit = FIELD_EX32(val, MODE_SELECT_REGISTER, SLEEP);
|
|
|
|
ARRAY_FIELD_DP32(s->regs, MODE_SELECT_REGISTER, SLEEP, sleep_mode_bit);
|
|
|
|
if (FIELD_EX32(val, MODE_SELECT_REGISTER, LBACK)) {
|
|
qemu_log_mask(LOG_GUEST_ERROR, "Attempting to set LBACK mode"
|
|
" without setting CEN bit as 0\n");
|
|
} else if (FIELD_EX32(val, MODE_SELECT_REGISTER, SNOOP)) {
|
|
qemu_log_mask(LOG_GUEST_ERROR, "Attempting to set SNOOP mode"
|
|
" without setting CEN bit as 0\n");
|
|
}
|
|
|
|
update_status_register_mode_bits(s);
|
|
}
|
|
|
|
return s->regs[R_MODE_SELECT_REGISTER];
|
|
}
|
|
|
|
static void canfd_exit_sleep_mode(XlnxVersalCANFDState *s)
|
|
{
|
|
ARRAY_FIELD_DP32(s->regs, MODE_SELECT_REGISTER, SLEEP, 0);
|
|
update_status_register_mode_bits(s);
|
|
}
|
|
|
|
static void regs2frame(XlnxVersalCANFDState *s, qemu_can_frame *frame,
|
|
uint32_t reg_num)
|
|
{
|
|
uint32_t i = 0;
|
|
uint32_t j = 0;
|
|
uint32_t val = 0;
|
|
uint32_t dlc_reg_val = 0;
|
|
uint32_t dlc_value = 0;
|
|
|
|
/* Check that reg_num should be within TX register space. */
|
|
assert(reg_num <= R_TB_ID_REGISTER + (NUM_REGS_PER_MSG_SPACE *
|
|
s->cfg.tx_fifo));
|
|
|
|
dlc_reg_val = s->regs[reg_num + 1];
|
|
dlc_value = FIELD_EX32(dlc_reg_val, TB0_DLC_REGISTER, DLC);
|
|
|
|
frame->can_id = s->regs[reg_num];
|
|
|
|
if (FIELD_EX32(dlc_reg_val, TB0_DLC_REGISTER, FDF)) {
|
|
/*
|
|
* CANFD frame.
|
|
* Converting dlc(0 to 15) 4 Byte data to plain length(i.e. 0 to 64)
|
|
* 1 Byte data. This is done to make it work with SocketCAN.
|
|
* On actual CANFD frame, this value can't be more than 0xF.
|
|
* Conversion table for DLC to plain length:
|
|
*
|
|
* DLC Plain Length
|
|
* 0 - 8 0 - 8
|
|
* 9 9 - 12
|
|
* 10 13 - 16
|
|
* 11 17 - 20
|
|
* 12 21 - 24
|
|
* 13 25 - 32
|
|
* 14 33 - 48
|
|
* 15 49 - 64
|
|
*/
|
|
|
|
frame->flags = QEMU_CAN_FRMF_TYPE_FD;
|
|
|
|
if (dlc_value < 8) {
|
|
frame->can_dlc = dlc_value;
|
|
} else {
|
|
assert((dlc_value - 8) < ARRAY_SIZE(canfd_dlc_array));
|
|
frame->can_dlc = canfd_dlc_array[dlc_value - 8];
|
|
}
|
|
} else {
|
|
/*
|
|
* FD Format bit not set that means it is a CAN Frame.
|
|
* Conversion table for classic CAN:
|
|
*
|
|
* DLC Plain Length
|
|
* 0 - 7 0 - 7
|
|
* 8 - 15 8
|
|
*/
|
|
|
|
if (dlc_value > 8) {
|
|
frame->can_dlc = 8;
|
|
qemu_log_mask(LOG_GUEST_ERROR, "Maximum DLC value for Classic CAN"
|
|
" frame is 8. Only 8 byte data will be sent.\n");
|
|
} else {
|
|
frame->can_dlc = dlc_value;
|
|
}
|
|
}
|
|
|
|
for (j = 0; j < frame->can_dlc; j++) {
|
|
val = 8 * i;
|
|
|
|
frame->data[j] = extract32(s->regs[reg_num + 2 + (j / 4)], val, 8);
|
|
i++;
|
|
|
|
if (i % 4 == 0) {
|
|
i = 0;
|
|
}
|
|
}
|
|
}
|
|
|
|
static void process_cancellation_requests(XlnxVersalCANFDState *s)
|
|
{
|
|
uint32_t clear_mask = s->regs[R_TX_BUFFER_READY_REQUEST_REGISTER] &
|
|
s->regs[R_TX_BUFFER_CANCEL_REQUEST_REGISTER];
|
|
|
|
s->regs[R_TX_BUFFER_READY_REQUEST_REGISTER] &= ~clear_mask;
|
|
s->regs[R_TX_BUFFER_CANCEL_REQUEST_REGISTER] &= ~clear_mask;
|
|
|
|
canfd_update_irq(s);
|
|
}
|
|
|
|
static void store_rx_sequential(XlnxVersalCANFDState *s,
|
|
const qemu_can_frame *frame,
|
|
uint32_t fill_level, uint32_t read_index,
|
|
uint32_t store_location, uint8_t rx_fifo,
|
|
bool rx_fifo_id, uint8_t filter_index)
|
|
{
|
|
int i;
|
|
bool is_canfd_frame;
|
|
uint8_t dlc = frame->can_dlc;
|
|
uint8_t rx_reg_num = 0;
|
|
uint32_t dlc_reg_val = 0;
|
|
uint32_t data_reg_val = 0;
|
|
|
|
/* Getting RX0/1 fill level */
|
|
if ((fill_level) > rx_fifo - 1) {
|
|
g_autofree char *path = object_get_canonical_path(OBJECT(s));
|
|
|
|
qemu_log_mask(LOG_GUEST_ERROR, "%s: RX%d Buffer is full. Discarding the"
|
|
" message\n", path, rx_fifo_id);
|
|
|
|
/* Set the corresponding RF buffer overflow interrupt. */
|
|
if (rx_fifo_id == 0) {
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, RXFOFLW, 1);
|
|
} else {
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, RXFOFLW_1, 1);
|
|
}
|
|
} else {
|
|
uint16_t rx_timestamp = CANFD_TIMER_MAX -
|
|
ptimer_get_count(s->canfd_timer);
|
|
|
|
if (rx_timestamp == 0xFFFF) {
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, TSCNT_OFLW, 1);
|
|
} else {
|
|
ARRAY_FIELD_DP32(s->regs, TIMESTAMP_REGISTER, TIMESTAMP_CNT,
|
|
rx_timestamp);
|
|
}
|
|
|
|
if (rx_fifo_id == 0) {
|
|
ARRAY_FIELD_DP32(s->regs, RX_FIFO_STATUS_REGISTER, FL,
|
|
fill_level + 1);
|
|
assert(store_location <=
|
|
R_RB_ID_REGISTER + (s->cfg.rx0_fifo *
|
|
NUM_REGS_PER_MSG_SPACE));
|
|
} else {
|
|
ARRAY_FIELD_DP32(s->regs, RX_FIFO_STATUS_REGISTER, FL_1,
|
|
fill_level + 1);
|
|
assert(store_location <=
|
|
R_RB_ID_REGISTER_1 + (s->cfg.rx1_fifo *
|
|
NUM_REGS_PER_MSG_SPACE));
|
|
}
|
|
|
|
s->regs[store_location] = frame->can_id;
|
|
|
|
dlc = frame->can_dlc;
|
|
|
|
if (frame->flags == QEMU_CAN_FRMF_TYPE_FD) {
|
|
is_canfd_frame = true;
|
|
|
|
/* Store dlc value in Xilinx specific format. */
|
|
for (i = 0; i < ARRAY_SIZE(canfd_dlc_array); i++) {
|
|
if (canfd_dlc_array[i] == frame->can_dlc) {
|
|
dlc_reg_val = FIELD_DP32(0, RB_DLC_REGISTER, DLC, 8 + i);
|
|
}
|
|
}
|
|
} else {
|
|
is_canfd_frame = false;
|
|
|
|
if (frame->can_dlc > 8) {
|
|
dlc = 8;
|
|
}
|
|
|
|
dlc_reg_val = FIELD_DP32(0, RB_DLC_REGISTER, DLC, dlc);
|
|
}
|
|
|
|
dlc_reg_val |= FIELD_DP32(0, RB_DLC_REGISTER, FDF, is_canfd_frame);
|
|
dlc_reg_val |= FIELD_DP32(0, RB_DLC_REGISTER, TIMESTAMP, rx_timestamp);
|
|
dlc_reg_val |= FIELD_DP32(0, RB_DLC_REGISTER, MATCHED_FILTER_INDEX,
|
|
filter_index);
|
|
s->regs[store_location + 1] = dlc_reg_val;
|
|
|
|
for (i = 0; i < dlc; i++) {
|
|
/* Register size is 4 byte but frame->data each is 1 byte. */
|
|
switch (i % 4) {
|
|
case 0:
|
|
rx_reg_num = i / 4;
|
|
|
|
data_reg_val = FIELD_DP32(0, RB_DW0_REGISTER, DATA_BYTES3,
|
|
frame->data[i]);
|
|
break;
|
|
case 1:
|
|
data_reg_val |= FIELD_DP32(0, RB_DW0_REGISTER, DATA_BYTES2,
|
|
frame->data[i]);
|
|
break;
|
|
case 2:
|
|
data_reg_val |= FIELD_DP32(0, RB_DW0_REGISTER, DATA_BYTES1,
|
|
frame->data[i]);
|
|
break;
|
|
case 3:
|
|
data_reg_val |= FIELD_DP32(0, RB_DW0_REGISTER, DATA_BYTES0,
|
|
frame->data[i]);
|
|
/*
|
|
* Last Bytes data which means we have all 4 bytes ready to
|
|
* store in one rx regs.
|
|
*/
|
|
s->regs[store_location + rx_reg_num + 2] = data_reg_val;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (i % 4) {
|
|
/*
|
|
* In case DLC is not multiplier of 4, data is not saved to RX FIFO
|
|
* in above switch case. Store the remaining bytes here.
|
|
*/
|
|
s->regs[store_location + rx_reg_num + 2] = data_reg_val;
|
|
}
|
|
|
|
/* set the interrupt as RXOK. */
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, RXOK, 1);
|
|
}
|
|
}
|
|
|
|
static void update_rx_sequential(XlnxVersalCANFDState *s,
|
|
const qemu_can_frame *frame)
|
|
{
|
|
bool filter_pass = false;
|
|
uint8_t filter_index = 0;
|
|
int i;
|
|
int filter_partition = ARRAY_FIELD_EX32(s->regs,
|
|
RX_FIFO_WATERMARK_REGISTER, RXFP);
|
|
uint32_t store_location;
|
|
uint32_t fill_level;
|
|
uint32_t read_index;
|
|
uint8_t store_index = 0;
|
|
g_autofree char *path = NULL;
|
|
/*
|
|
* If all UAF bits are set to 0, then received messages are not stored
|
|
* in the RX buffers.
|
|
*/
|
|
if (s->regs[R_ACCEPTANCE_FILTER_CONTROL_REGISTER]) {
|
|
uint32_t acceptance_filter_status =
|
|
s->regs[R_ACCEPTANCE_FILTER_CONTROL_REGISTER];
|
|
|
|
for (i = 0; i < 32; i++) {
|
|
if (acceptance_filter_status & 0x1) {
|
|
uint32_t msg_id_masked = s->regs[R_AFMR_REGISTER + 2 * i] &
|
|
frame->can_id;
|
|
uint32_t afir_id_masked = s->regs[R_AFIR_REGISTER + 2 * i] &
|
|
s->regs[R_AFMR_REGISTER + 2 * i];
|
|
uint16_t std_msg_id_masked = FIELD_EX32(msg_id_masked,
|
|
AFIR_REGISTER, AIID);
|
|
uint16_t std_afir_id_masked = FIELD_EX32(afir_id_masked,
|
|
AFIR_REGISTER, AIID);
|
|
uint32_t ext_msg_id_masked = FIELD_EX32(msg_id_masked,
|
|
AFIR_REGISTER,
|
|
AIID_EXT);
|
|
uint32_t ext_afir_id_masked = FIELD_EX32(afir_id_masked,
|
|
AFIR_REGISTER,
|
|
AIID_EXT);
|
|
bool ext_ide = FIELD_EX32(s->regs[R_AFMR_REGISTER + 2 * i],
|
|
AFMR_REGISTER, AMIDE);
|
|
|
|
if (std_msg_id_masked == std_afir_id_masked) {
|
|
if (ext_ide) {
|
|
/* Extended message ID message. */
|
|
if (ext_msg_id_masked == ext_afir_id_masked) {
|
|
filter_pass = true;
|
|
filter_index = i;
|
|
|
|
break;
|
|
}
|
|
} else {
|
|
/* Standard message ID. */
|
|
filter_pass = true;
|
|
filter_index = i;
|
|
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
acceptance_filter_status >>= 1;
|
|
}
|
|
}
|
|
|
|
if (!filter_pass) {
|
|
path = object_get_canonical_path(OBJECT(s));
|
|
|
|
trace_xlnx_canfd_rx_fifo_filter_reject(path, frame->can_id,
|
|
frame->can_dlc);
|
|
} else {
|
|
if (filter_index <= filter_partition) {
|
|
fill_level = ARRAY_FIELD_EX32(s->regs, RX_FIFO_STATUS_REGISTER, FL);
|
|
read_index = ARRAY_FIELD_EX32(s->regs, RX_FIFO_STATUS_REGISTER, RI);
|
|
store_index = read_index + fill_level;
|
|
|
|
if (read_index == s->cfg.rx0_fifo - 1) {
|
|
/*
|
|
* When ri is s->cfg.rx0_fifo - 1 i.e. max, it goes cyclic that
|
|
* means we reset the ri to 0x0.
|
|
*/
|
|
read_index = 0;
|
|
ARRAY_FIELD_DP32(s->regs, RX_FIFO_STATUS_REGISTER, RI,
|
|
read_index);
|
|
}
|
|
|
|
if (store_index > s->cfg.rx0_fifo - 1) {
|
|
store_index -= s->cfg.rx0_fifo - 1;
|
|
}
|
|
|
|
store_location = R_RB_ID_REGISTER +
|
|
(store_index * NUM_REGS_PER_MSG_SPACE);
|
|
|
|
store_rx_sequential(s, frame, fill_level, read_index,
|
|
store_location, s->cfg.rx0_fifo, 0,
|
|
filter_index);
|
|
} else {
|
|
/* RX 1 fill level message */
|
|
fill_level = ARRAY_FIELD_EX32(s->regs, RX_FIFO_STATUS_REGISTER,
|
|
FL_1);
|
|
read_index = ARRAY_FIELD_EX32(s->regs, RX_FIFO_STATUS_REGISTER,
|
|
RI_1);
|
|
store_index = read_index + fill_level;
|
|
|
|
if (read_index == s->cfg.rx1_fifo - 1) {
|
|
/*
|
|
* When ri is s->cfg.rx1_fifo - 1 i.e. max, it goes cyclic that
|
|
* means we reset the ri to 0x0.
|
|
*/
|
|
read_index = 0;
|
|
ARRAY_FIELD_DP32(s->regs, RX_FIFO_STATUS_REGISTER, RI_1,
|
|
read_index);
|
|
}
|
|
|
|
if (store_index > s->cfg.rx1_fifo - 1) {
|
|
store_index -= s->cfg.rx1_fifo - 1;
|
|
}
|
|
|
|
store_location = R_RB_ID_REGISTER_1 +
|
|
(store_index * NUM_REGS_PER_MSG_SPACE);
|
|
|
|
store_rx_sequential(s, frame, fill_level, read_index,
|
|
store_location, s->cfg.rx1_fifo, 1,
|
|
filter_index);
|
|
}
|
|
|
|
path = object_get_canonical_path(OBJECT(s));
|
|
|
|
trace_xlnx_canfd_rx_data(path, frame->can_id, frame->can_dlc,
|
|
frame->flags);
|
|
canfd_update_irq(s);
|
|
}
|
|
}
|
|
|
|
static bool tx_ready_check(XlnxVersalCANFDState *s)
|
|
{
|
|
if (ARRAY_FIELD_EX32(s->regs, SOFTWARE_RESET_REGISTER, SRST)) {
|
|
g_autofree char *path = object_get_canonical_path(OBJECT(s));
|
|
|
|
qemu_log_mask(LOG_GUEST_ERROR, "%s: Attempting to transfer data while"
|
|
" XlnxVersalCANFDState is in reset mode\n", path);
|
|
|
|
return false;
|
|
}
|
|
|
|
if (ARRAY_FIELD_EX32(s->regs, SOFTWARE_RESET_REGISTER, CEN) == 0) {
|
|
g_autofree char *path = object_get_canonical_path(OBJECT(s));
|
|
|
|
qemu_log_mask(LOG_GUEST_ERROR, "%s: Attempting to transfer data while"
|
|
" XlnxVersalCANFDState is in configuration mode."
|
|
" Reset the core so operations can start fresh\n",
|
|
path);
|
|
return false;
|
|
}
|
|
|
|
if (ARRAY_FIELD_EX32(s->regs, MODE_SELECT_REGISTER, SNOOP)) {
|
|
g_autofree char *path = object_get_canonical_path(OBJECT(s));
|
|
|
|
qemu_log_mask(LOG_GUEST_ERROR, "%s: Attempting to transfer data while"
|
|
" XlnxVersalCANFDState is in SNOOP MODE\n",
|
|
path);
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
static void tx_fifo_stamp(XlnxVersalCANFDState *s, uint32_t tb0_regid)
|
|
{
|
|
/*
|
|
* If EFC bit in DLC message is set, this means we will store the
|
|
* event of this transmitted message with time stamp.
|
|
*/
|
|
uint32_t dlc_reg_val = 0;
|
|
|
|
if (FIELD_EX32(s->regs[tb0_regid + 1], TB0_DLC_REGISTER, EFC)) {
|
|
uint8_t dlc_val = FIELD_EX32(s->regs[tb0_regid + 1], TB0_DLC_REGISTER,
|
|
DLC);
|
|
bool fdf_val = FIELD_EX32(s->regs[tb0_regid + 1], TB0_DLC_REGISTER,
|
|
FDF);
|
|
bool brs_val = FIELD_EX32(s->regs[tb0_regid + 1], TB0_DLC_REGISTER,
|
|
BRS);
|
|
uint8_t mm_val = FIELD_EX32(s->regs[tb0_regid + 1], TB0_DLC_REGISTER,
|
|
MM);
|
|
uint8_t fill_level = ARRAY_FIELD_EX32(s->regs,
|
|
TX_EVENT_FIFO_STATUS_REGISTER,
|
|
TXE_FL);
|
|
uint8_t read_index = ARRAY_FIELD_EX32(s->regs,
|
|
TX_EVENT_FIFO_STATUS_REGISTER,
|
|
TXE_RI);
|
|
uint8_t store_index = fill_level + read_index;
|
|
|
|
if ((fill_level) > s->cfg.tx_fifo - 1) {
|
|
qemu_log_mask(LOG_GUEST_ERROR, "TX Event Buffer is full."
|
|
" Discarding the message\n");
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, TXEOFLW, 1);
|
|
} else {
|
|
if (read_index == s->cfg.tx_fifo - 1) {
|
|
/*
|
|
* When ri is s->cfg.tx_fifo - 1 i.e. max, it goes cyclic that
|
|
* means we reset the ri to 0x0.
|
|
*/
|
|
read_index = 0;
|
|
ARRAY_FIELD_DP32(s->regs, TX_EVENT_FIFO_STATUS_REGISTER, TXE_RI,
|
|
read_index);
|
|
}
|
|
|
|
if (store_index > s->cfg.tx_fifo - 1) {
|
|
store_index -= s->cfg.tx_fifo - 1;
|
|
}
|
|
|
|
assert(store_index < s->cfg.tx_fifo);
|
|
|
|
uint32_t tx_event_reg0_id = R_TXE_FIFO_TB_ID_REGISTER +
|
|
(store_index * 2);
|
|
|
|
/* Store message ID in TX event register. */
|
|
s->regs[tx_event_reg0_id] = s->regs[tb0_regid];
|
|
|
|
uint16_t tx_timestamp = CANFD_TIMER_MAX -
|
|
ptimer_get_count(s->canfd_timer);
|
|
|
|
/* Store DLC with time stamp in DLC regs. */
|
|
dlc_reg_val = FIELD_DP32(0, TXE_FIFO_TB_DLC_REGISTER, DLC, dlc_val);
|
|
dlc_reg_val |= FIELD_DP32(0, TXE_FIFO_TB_DLC_REGISTER, FDF,
|
|
fdf_val);
|
|
dlc_reg_val |= FIELD_DP32(0, TXE_FIFO_TB_DLC_REGISTER, BRS,
|
|
brs_val);
|
|
dlc_reg_val |= FIELD_DP32(0, TXE_FIFO_TB_DLC_REGISTER, ET, 0x3);
|
|
dlc_reg_val |= FIELD_DP32(0, TXE_FIFO_TB_DLC_REGISTER, MM, mm_val);
|
|
dlc_reg_val |= FIELD_DP32(0, TXE_FIFO_TB_DLC_REGISTER, TIMESTAMP,
|
|
tx_timestamp);
|
|
s->regs[tx_event_reg0_id + 1] = dlc_reg_val;
|
|
|
|
ARRAY_FIELD_DP32(s->regs, TX_EVENT_FIFO_STATUS_REGISTER, TXE_FL,
|
|
fill_level + 1);
|
|
}
|
|
}
|
|
}
|
|
|
|
static gint g_cmp_ids(gconstpointer data1, gconstpointer data2)
|
|
{
|
|
tx_ready_reg_info *tx_reg_1 = (tx_ready_reg_info *) data1;
|
|
tx_ready_reg_info *tx_reg_2 = (tx_ready_reg_info *) data2;
|
|
|
|
return tx_reg_1->can_id - tx_reg_2->can_id;
|
|
}
|
|
|
|
static void free_list(GSList *list)
|
|
{
|
|
GSList *iterator = NULL;
|
|
|
|
for (iterator = list; iterator != NULL; iterator = iterator->next) {
|
|
g_free((tx_ready_reg_info *)iterator->data);
|
|
}
|
|
|
|
g_slist_free(list);
|
|
|
|
return;
|
|
}
|
|
|
|
static GSList *prepare_tx_data(XlnxVersalCANFDState *s)
|
|
{
|
|
uint8_t i = 0;
|
|
GSList *list = NULL;
|
|
uint32_t reg_num = 0;
|
|
uint32_t reg_ready = s->regs[R_TX_BUFFER_READY_REQUEST_REGISTER];
|
|
|
|
/* First find the messages which are ready for transmission. */
|
|
for (i = 0; i < s->cfg.tx_fifo; i++) {
|
|
if (reg_ready & 1) {
|
|
reg_num = R_TB_ID_REGISTER + (NUM_REGS_PER_MSG_SPACE * i);
|
|
tx_ready_reg_info *temp = g_new(tx_ready_reg_info, 1);
|
|
|
|
temp->can_id = s->regs[reg_num];
|
|
temp->reg_num = reg_num;
|
|
list = g_slist_prepend(list, temp);
|
|
list = g_slist_sort(list, g_cmp_ids);
|
|
}
|
|
|
|
reg_ready >>= 1;
|
|
}
|
|
|
|
s->regs[R_TX_BUFFER_READY_REQUEST_REGISTER] = 0;
|
|
s->regs[R_TX_BUFFER_CANCEL_REQUEST_REGISTER] = 0;
|
|
|
|
return list;
|
|
}
|
|
|
|
static void transfer_data(XlnxVersalCANFDState *s)
|
|
{
|
|
bool canfd_tx = tx_ready_check(s);
|
|
GSList *list, *iterator = NULL;
|
|
qemu_can_frame frame;
|
|
|
|
if (!canfd_tx) {
|
|
g_autofree char *path = object_get_canonical_path(OBJECT(s));
|
|
|
|
qemu_log_mask(LOG_GUEST_ERROR, "%s: Controller not enabled for data"
|
|
" transfer\n", path);
|
|
return;
|
|
}
|
|
|
|
list = prepare_tx_data(s);
|
|
if (list == NULL) {
|
|
return;
|
|
}
|
|
|
|
for (iterator = list; iterator != NULL; iterator = iterator->next) {
|
|
regs2frame(s, &frame,
|
|
((tx_ready_reg_info *)iterator->data)->reg_num);
|
|
|
|
if (ARRAY_FIELD_EX32(s->regs, STATUS_REGISTER, LBACK)) {
|
|
update_rx_sequential(s, &frame);
|
|
tx_fifo_stamp(s, ((tx_ready_reg_info *)iterator->data)->reg_num);
|
|
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, RXOK, 1);
|
|
} else {
|
|
g_autofree char *path = object_get_canonical_path(OBJECT(s));
|
|
|
|
trace_xlnx_canfd_tx_data(path, frame.can_id, frame.can_dlc,
|
|
frame.flags);
|
|
can_bus_client_send(&s->bus_client, &frame, 1);
|
|
tx_fifo_stamp(s,
|
|
((tx_ready_reg_info *)iterator->data)->reg_num);
|
|
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, TXRRS, 1);
|
|
|
|
if (ARRAY_FIELD_EX32(s->regs, STATUS_REGISTER, SLEEP)) {
|
|
canfd_exit_sleep_mode(s);
|
|
}
|
|
}
|
|
}
|
|
|
|
ARRAY_FIELD_DP32(s->regs, INTERRUPT_STATUS_REGISTER, TXOK, 1);
|
|
free_list(list);
|
|
|
|
canfd_update_irq(s);
|
|
}
|
|
|
|
static uint64_t canfd_srr_pre_write(RegisterInfo *reg, uint64_t val64)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(reg->opaque);
|
|
uint32_t val = val64;
|
|
|
|
ARRAY_FIELD_DP32(s->regs, SOFTWARE_RESET_REGISTER, CEN,
|
|
FIELD_EX32(val, SOFTWARE_RESET_REGISTER, CEN));
|
|
|
|
if (FIELD_EX32(val, SOFTWARE_RESET_REGISTER, SRST)) {
|
|
g_autofree char *path = object_get_canonical_path(OBJECT(s));
|
|
|
|
trace_xlnx_canfd_reset(path, val64);
|
|
|
|
/* First, core will do software reset then will enter in config mode. */
|
|
canfd_config_reset(s);
|
|
} else if (ARRAY_FIELD_EX32(s->regs, SOFTWARE_RESET_REGISTER, CEN) == 0) {
|
|
canfd_config_mode(s);
|
|
} else {
|
|
/*
|
|
* Leave config mode. Now XlnxVersalCANFD core will enter Normal, Sleep,
|
|
* snoop or Loopback mode depending upon LBACK, SLEEP, SNOOP register
|
|
* states.
|
|
*/
|
|
ARRAY_FIELD_DP32(s->regs, STATUS_REGISTER, CONFIG, 0);
|
|
|
|
ptimer_transaction_begin(s->canfd_timer);
|
|
ptimer_set_count(s->canfd_timer, 0);
|
|
ptimer_transaction_commit(s->canfd_timer);
|
|
update_status_register_mode_bits(s);
|
|
transfer_data(s);
|
|
}
|
|
|
|
return s->regs[R_SOFTWARE_RESET_REGISTER];
|
|
}
|
|
|
|
static uint64_t filter_mask(RegisterInfo *reg, uint64_t val64)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(reg->opaque);
|
|
uint32_t reg_idx = (reg->access->addr) / 4;
|
|
uint32_t val = val64;
|
|
uint32_t filter_offset = (reg_idx - R_AFMR_REGISTER) / 2;
|
|
|
|
if (!(s->regs[R_ACCEPTANCE_FILTER_CONTROL_REGISTER] &
|
|
(1 << filter_offset))) {
|
|
s->regs[reg_idx] = val;
|
|
} else {
|
|
g_autofree char *path = object_get_canonical_path(OBJECT(s));
|
|
|
|
qemu_log_mask(LOG_GUEST_ERROR, "%s: Acceptance filter %d not enabled\n",
|
|
path, filter_offset + 1);
|
|
}
|
|
|
|
return s->regs[reg_idx];
|
|
}
|
|
|
|
static uint64_t filter_id(RegisterInfo *reg, uint64_t val64)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(reg->opaque);
|
|
hwaddr reg_idx = (reg->access->addr) / 4;
|
|
uint32_t val = val64;
|
|
uint32_t filter_offset = (reg_idx - R_AFIR_REGISTER) / 2;
|
|
|
|
if (!(s->regs[R_ACCEPTANCE_FILTER_CONTROL_REGISTER] &
|
|
(1 << filter_offset))) {
|
|
s->regs[reg_idx] = val;
|
|
} else {
|
|
g_autofree char *path = object_get_canonical_path(OBJECT(s));
|
|
|
|
qemu_log_mask(LOG_GUEST_ERROR, "%s: Acceptance filter %d not enabled\n",
|
|
path, filter_offset + 1);
|
|
}
|
|
|
|
return s->regs[reg_idx];
|
|
}
|
|
|
|
static uint64_t canfd_tx_fifo_status_prew(RegisterInfo *reg, uint64_t val64)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(reg->opaque);
|
|
uint32_t val = val64;
|
|
uint8_t read_ind = 0;
|
|
uint8_t fill_ind = ARRAY_FIELD_EX32(s->regs, TX_EVENT_FIFO_STATUS_REGISTER,
|
|
TXE_FL);
|
|
|
|
if (FIELD_EX32(val, TX_EVENT_FIFO_STATUS_REGISTER, TXE_IRI) && fill_ind) {
|
|
read_ind = ARRAY_FIELD_EX32(s->regs, TX_EVENT_FIFO_STATUS_REGISTER,
|
|
TXE_RI) + 1;
|
|
|
|
if (read_ind > s->cfg.tx_fifo - 1) {
|
|
read_ind = 0;
|
|
}
|
|
|
|
/*
|
|
* Increase the read index by 1 and decrease the fill level by 1.
|
|
*/
|
|
ARRAY_FIELD_DP32(s->regs, TX_EVENT_FIFO_STATUS_REGISTER, TXE_RI,
|
|
read_ind);
|
|
ARRAY_FIELD_DP32(s->regs, TX_EVENT_FIFO_STATUS_REGISTER, TXE_FL,
|
|
fill_ind - 1);
|
|
}
|
|
|
|
return s->regs[R_TX_EVENT_FIFO_STATUS_REGISTER];
|
|
}
|
|
|
|
static uint64_t canfd_rx_fifo_status_prew(RegisterInfo *reg, uint64_t val64)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(reg->opaque);
|
|
uint32_t val = val64;
|
|
uint8_t read_ind = 0;
|
|
uint8_t fill_ind = 0;
|
|
|
|
if (FIELD_EX32(val, RX_FIFO_STATUS_REGISTER, IRI)) {
|
|
/* FL index is zero, setting IRI bit has no effect. */
|
|
if (FIELD_EX32(val, RX_FIFO_STATUS_REGISTER, FL) != 0) {
|
|
read_ind = FIELD_EX32(val, RX_FIFO_STATUS_REGISTER, RI) + 1;
|
|
|
|
if (read_ind > s->cfg.rx0_fifo - 1) {
|
|
read_ind = 0;
|
|
}
|
|
|
|
fill_ind = FIELD_EX32(val, RX_FIFO_STATUS_REGISTER, FL) - 1;
|
|
|
|
ARRAY_FIELD_DP32(s->regs, RX_FIFO_STATUS_REGISTER, RI, read_ind);
|
|
ARRAY_FIELD_DP32(s->regs, RX_FIFO_STATUS_REGISTER, FL, fill_ind);
|
|
}
|
|
}
|
|
|
|
if (FIELD_EX32(val, RX_FIFO_STATUS_REGISTER, IRI_1)) {
|
|
/* FL_1 index is zero, setting IRI_1 bit has no effect. */
|
|
if (FIELD_EX32(val, RX_FIFO_STATUS_REGISTER, FL_1) != 0) {
|
|
read_ind = FIELD_EX32(val, RX_FIFO_STATUS_REGISTER, RI_1) + 1;
|
|
|
|
if (read_ind > s->cfg.rx1_fifo - 1) {
|
|
read_ind = 0;
|
|
}
|
|
|
|
fill_ind = FIELD_EX32(val, RX_FIFO_STATUS_REGISTER, FL_1) - 1;
|
|
|
|
ARRAY_FIELD_DP32(s->regs, RX_FIFO_STATUS_REGISTER, RI_1, read_ind);
|
|
ARRAY_FIELD_DP32(s->regs, RX_FIFO_STATUS_REGISTER, FL_1, fill_ind);
|
|
}
|
|
}
|
|
|
|
return s->regs[R_RX_FIFO_STATUS_REGISTER];
|
|
}
|
|
|
|
static uint64_t canfd_tsr_pre_write(RegisterInfo *reg, uint64_t val64)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(reg->opaque);
|
|
uint32_t val = val64;
|
|
|
|
if (FIELD_EX32(val, TIMESTAMP_REGISTER, CTS)) {
|
|
ARRAY_FIELD_DP32(s->regs, TIMESTAMP_REGISTER, TIMESTAMP_CNT, 0);
|
|
ptimer_transaction_begin(s->canfd_timer);
|
|
ptimer_set_count(s->canfd_timer, 0);
|
|
ptimer_transaction_commit(s->canfd_timer);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static uint64_t canfd_trr_reg_prew(RegisterInfo *reg, uint64_t val64)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(reg->opaque);
|
|
|
|
if (ARRAY_FIELD_EX32(s->regs, MODE_SELECT_REGISTER, SNOOP)) {
|
|
g_autofree char *path = object_get_canonical_path(OBJECT(s));
|
|
|
|
qemu_log_mask(LOG_GUEST_ERROR, "%s: Controller is in SNOOP mode."
|
|
" tx_ready_register will stay in reset mode\n", path);
|
|
return 0;
|
|
} else {
|
|
return val64;
|
|
}
|
|
}
|
|
|
|
static void canfd_trr_reg_postw(RegisterInfo *reg, uint64_t val64)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(reg->opaque);
|
|
|
|
transfer_data(s);
|
|
}
|
|
|
|
static void canfd_cancel_reg_postw(RegisterInfo *reg, uint64_t val64)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(reg->opaque);
|
|
|
|
process_cancellation_requests(s);
|
|
}
|
|
|
|
static uint64_t canfd_write_check_prew(RegisterInfo *reg, uint64_t val64)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(reg->opaque);
|
|
uint32_t val = val64;
|
|
|
|
if (ARRAY_FIELD_EX32(s->regs, SOFTWARE_RESET_REGISTER, CEN) == 0) {
|
|
return val;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static const RegisterAccessInfo canfd_tx_regs[] = {
|
|
{ .name = "TB_ID_REGISTER", .addr = A_TB_ID_REGISTER,
|
|
},{ .name = "TB0_DLC_REGISTER", .addr = A_TB0_DLC_REGISTER,
|
|
},{ .name = "TB_DW0_REGISTER", .addr = A_TB_DW0_REGISTER,
|
|
},{ .name = "TB_DW1_REGISTER", .addr = A_TB_DW1_REGISTER,
|
|
},{ .name = "TB_DW2_REGISTER", .addr = A_TB_DW2_REGISTER,
|
|
},{ .name = "TB_DW3_REGISTER", .addr = A_TB_DW3_REGISTER,
|
|
},{ .name = "TB_DW4_REGISTER", .addr = A_TB_DW4_REGISTER,
|
|
},{ .name = "TB_DW5_REGISTER", .addr = A_TB_DW5_REGISTER,
|
|
},{ .name = "TB_DW6_REGISTER", .addr = A_TB_DW6_REGISTER,
|
|
},{ .name = "TB_DW7_REGISTER", .addr = A_TB_DW7_REGISTER,
|
|
},{ .name = "TB_DW8_REGISTER", .addr = A_TB_DW8_REGISTER,
|
|
},{ .name = "TB_DW9_REGISTER", .addr = A_TB_DW9_REGISTER,
|
|
},{ .name = "TB_DW10_REGISTER", .addr = A_TB_DW10_REGISTER,
|
|
},{ .name = "TB_DW11_REGISTER", .addr = A_TB_DW11_REGISTER,
|
|
},{ .name = "TB_DW12_REGISTER", .addr = A_TB_DW12_REGISTER,
|
|
},{ .name = "TB_DW13_REGISTER", .addr = A_TB_DW13_REGISTER,
|
|
},{ .name = "TB_DW14_REGISTER", .addr = A_TB_DW14_REGISTER,
|
|
},{ .name = "TB_DW15_REGISTER", .addr = A_TB_DW15_REGISTER,
|
|
}
|
|
};
|
|
|
|
static const RegisterAccessInfo canfd_rx0_regs[] = {
|
|
{ .name = "RB_ID_REGISTER", .addr = A_RB_ID_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DLC_REGISTER", .addr = A_RB_DLC_REGISTER,
|
|
.ro = 0xfe1fffff,
|
|
},{ .name = "RB_DW0_REGISTER", .addr = A_RB_DW0_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW1_REGISTER", .addr = A_RB_DW1_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW2_REGISTER", .addr = A_RB_DW2_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW3_REGISTER", .addr = A_RB_DW3_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW4_REGISTER", .addr = A_RB_DW4_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW5_REGISTER", .addr = A_RB_DW5_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW6_REGISTER", .addr = A_RB_DW6_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW7_REGISTER", .addr = A_RB_DW7_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW8_REGISTER", .addr = A_RB_DW8_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW9_REGISTER", .addr = A_RB_DW9_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW10_REGISTER", .addr = A_RB_DW10_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW11_REGISTER", .addr = A_RB_DW11_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW12_REGISTER", .addr = A_RB_DW12_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW13_REGISTER", .addr = A_RB_DW13_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW14_REGISTER", .addr = A_RB_DW14_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW15_REGISTER", .addr = A_RB_DW15_REGISTER,
|
|
.ro = 0xffffffff,
|
|
}
|
|
};
|
|
|
|
static const RegisterAccessInfo canfd_rx1_regs[] = {
|
|
{ .name = "RB_ID_REGISTER_1", .addr = A_RB_ID_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DLC_REGISTER_1", .addr = A_RB_DLC_REGISTER_1,
|
|
.ro = 0xfe1fffff,
|
|
},{ .name = "RB0_DW0_REGISTER_1", .addr = A_RB0_DW0_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW1_REGISTER_1", .addr = A_RB_DW1_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW2_REGISTER_1", .addr = A_RB_DW2_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW3_REGISTER_1", .addr = A_RB_DW3_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW4_REGISTER_1", .addr = A_RB_DW4_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW5_REGISTER_1", .addr = A_RB_DW5_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW6_REGISTER_1", .addr = A_RB_DW6_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW7_REGISTER_1", .addr = A_RB_DW7_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW8_REGISTER_1", .addr = A_RB_DW8_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW9_REGISTER_1", .addr = A_RB_DW9_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW10_REGISTER_1", .addr = A_RB_DW10_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW11_REGISTER_1", .addr = A_RB_DW11_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW12_REGISTER_1", .addr = A_RB_DW12_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW13_REGISTER_1", .addr = A_RB_DW13_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW14_REGISTER_1", .addr = A_RB_DW14_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "RB_DW15_REGISTER_1", .addr = A_RB_DW15_REGISTER_1,
|
|
.ro = 0xffffffff,
|
|
}
|
|
};
|
|
|
|
/* Acceptance filter registers. */
|
|
static const RegisterAccessInfo canfd_af_regs[] = {
|
|
{ .name = "AFMR_REGISTER", .addr = A_AFMR_REGISTER,
|
|
.pre_write = filter_mask,
|
|
},{ .name = "AFIR_REGISTER", .addr = A_AFIR_REGISTER,
|
|
.pre_write = filter_id,
|
|
}
|
|
};
|
|
|
|
static const RegisterAccessInfo canfd_txe_regs[] = {
|
|
{ .name = "TXE_FIFO_TB_ID_REGISTER", .addr = A_TXE_FIFO_TB_ID_REGISTER,
|
|
.ro = 0xffffffff,
|
|
},{ .name = "TXE_FIFO_TB_DLC_REGISTER", .addr = A_TXE_FIFO_TB_DLC_REGISTER,
|
|
.ro = 0xffffffff,
|
|
}
|
|
};
|
|
|
|
static const RegisterAccessInfo canfd_regs_info[] = {
|
|
{ .name = "SOFTWARE_RESET_REGISTER", .addr = A_SOFTWARE_RESET_REGISTER,
|
|
.pre_write = canfd_srr_pre_write,
|
|
},{ .name = "MODE_SELECT_REGISTER", .addr = A_MODE_SELECT_REGISTER,
|
|
.pre_write = canfd_msr_pre_write,
|
|
},{ .name = "ARBITRATION_PHASE_BAUD_RATE_PRESCALER_REGISTER",
|
|
.addr = A_ARBITRATION_PHASE_BAUD_RATE_PRESCALER_REGISTER,
|
|
.pre_write = canfd_write_check_prew,
|
|
},{ .name = "ARBITRATION_PHASE_BIT_TIMING_REGISTER",
|
|
.addr = A_ARBITRATION_PHASE_BIT_TIMING_REGISTER,
|
|
.pre_write = canfd_write_check_prew,
|
|
},{ .name = "ERROR_COUNTER_REGISTER", .addr = A_ERROR_COUNTER_REGISTER,
|
|
.ro = 0xffff,
|
|
},{ .name = "ERROR_STATUS_REGISTER", .addr = A_ERROR_STATUS_REGISTER,
|
|
.w1c = 0xf1f,
|
|
},{ .name = "STATUS_REGISTER", .addr = A_STATUS_REGISTER,
|
|
.reset = 0x1,
|
|
.ro = 0x7f17ff,
|
|
},{ .name = "INTERRUPT_STATUS_REGISTER",
|
|
.addr = A_INTERRUPT_STATUS_REGISTER,
|
|
.ro = 0xffffff7f,
|
|
},{ .name = "INTERRUPT_ENABLE_REGISTER",
|
|
.addr = A_INTERRUPT_ENABLE_REGISTER,
|
|
.post_write = canfd_ier_post_write,
|
|
},{ .name = "INTERRUPT_CLEAR_REGISTER",
|
|
.addr = A_INTERRUPT_CLEAR_REGISTER, .pre_write = canfd_icr_pre_write,
|
|
},{ .name = "TIMESTAMP_REGISTER", .addr = A_TIMESTAMP_REGISTER,
|
|
.ro = 0xffff0000,
|
|
.pre_write = canfd_tsr_pre_write,
|
|
},{ .name = "DATA_PHASE_BAUD_RATE_PRESCALER_REGISTER",
|
|
.addr = A_DATA_PHASE_BAUD_RATE_PRESCALER_REGISTER,
|
|
.pre_write = canfd_write_check_prew,
|
|
},{ .name = "DATA_PHASE_BIT_TIMING_REGISTER",
|
|
.addr = A_DATA_PHASE_BIT_TIMING_REGISTER,
|
|
.pre_write = canfd_write_check_prew,
|
|
},{ .name = "TX_BUFFER_READY_REQUEST_REGISTER",
|
|
.addr = A_TX_BUFFER_READY_REQUEST_REGISTER,
|
|
.pre_write = canfd_trr_reg_prew,
|
|
.post_write = canfd_trr_reg_postw,
|
|
},{ .name = "INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER",
|
|
.addr = A_INTERRUPT_ENABLE_TX_BUFFER_READY_REQUEST_REGISTER,
|
|
},{ .name = "TX_BUFFER_CANCEL_REQUEST_REGISTER",
|
|
.addr = A_TX_BUFFER_CANCEL_REQUEST_REGISTER,
|
|
.post_write = canfd_cancel_reg_postw,
|
|
},{ .name = "INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER",
|
|
.addr = A_INTERRUPT_ENABLE_TX_BUFFER_CANCELLATION_REQUEST_REGISTER,
|
|
},{ .name = "TX_EVENT_FIFO_STATUS_REGISTER",
|
|
.addr = A_TX_EVENT_FIFO_STATUS_REGISTER,
|
|
.ro = 0x3f1f, .pre_write = canfd_tx_fifo_status_prew,
|
|
},{ .name = "TX_EVENT_FIFO_WATERMARK_REGISTER",
|
|
.addr = A_TX_EVENT_FIFO_WATERMARK_REGISTER,
|
|
.reset = 0xf,
|
|
.pre_write = canfd_write_check_prew,
|
|
},{ .name = "ACCEPTANCE_FILTER_CONTROL_REGISTER",
|
|
.addr = A_ACCEPTANCE_FILTER_CONTROL_REGISTER,
|
|
},{ .name = "RX_FIFO_STATUS_REGISTER", .addr = A_RX_FIFO_STATUS_REGISTER,
|
|
.ro = 0x7f3f7f3f, .pre_write = canfd_rx_fifo_status_prew,
|
|
},{ .name = "RX_FIFO_WATERMARK_REGISTER",
|
|
.addr = A_RX_FIFO_WATERMARK_REGISTER,
|
|
.reset = 0x1f0f0f,
|
|
.pre_write = canfd_write_check_prew,
|
|
}
|
|
};
|
|
|
|
static void xlnx_versal_canfd_ptimer_cb(void *opaque)
|
|
{
|
|
/* No action required on the timer rollover. */
|
|
}
|
|
|
|
static const MemoryRegionOps canfd_ops = {
|
|
.read = register_read_memory,
|
|
.write = register_write_memory,
|
|
.endianness = DEVICE_LITTLE_ENDIAN,
|
|
.valid = {
|
|
.min_access_size = 4,
|
|
.max_access_size = 4,
|
|
},
|
|
};
|
|
|
|
static void canfd_reset(DeviceState *dev)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(dev);
|
|
unsigned int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(s->reg_info); ++i) {
|
|
register_reset(&s->reg_info[i]);
|
|
}
|
|
|
|
ptimer_transaction_begin(s->canfd_timer);
|
|
ptimer_set_count(s->canfd_timer, 0);
|
|
ptimer_transaction_commit(s->canfd_timer);
|
|
}
|
|
|
|
static bool can_xilinx_canfd_receive(CanBusClientState *client)
|
|
{
|
|
XlnxVersalCANFDState *s = container_of(client, XlnxVersalCANFDState,
|
|
bus_client);
|
|
|
|
bool reset_state = ARRAY_FIELD_EX32(s->regs, SOFTWARE_RESET_REGISTER, SRST);
|
|
bool can_enabled = ARRAY_FIELD_EX32(s->regs, SOFTWARE_RESET_REGISTER, CEN);
|
|
|
|
return !reset_state && can_enabled;
|
|
}
|
|
|
|
static ssize_t canfd_xilinx_receive(CanBusClientState *client,
|
|
const qemu_can_frame *buf,
|
|
size_t buf_size)
|
|
{
|
|
XlnxVersalCANFDState *s = container_of(client, XlnxVersalCANFDState,
|
|
bus_client);
|
|
const qemu_can_frame *frame = buf;
|
|
|
|
assert(buf_size > 0);
|
|
|
|
if (ARRAY_FIELD_EX32(s->regs, STATUS_REGISTER, LBACK)) {
|
|
/*
|
|
* XlnxVersalCANFDState will not participate in normal bus communication
|
|
* and does not receive any messages transmitted by other CAN nodes.
|
|
*/
|
|
return 1;
|
|
}
|
|
|
|
/* Update the status register that we are receiving message. */
|
|
ARRAY_FIELD_DP32(s->regs, STATUS_REGISTER, BBSY, 1);
|
|
|
|
if (ARRAY_FIELD_EX32(s->regs, STATUS_REGISTER, SNOOP)) {
|
|
/* Snoop Mode: Just keep the data. no response back. */
|
|
update_rx_sequential(s, frame);
|
|
} else {
|
|
if ((ARRAY_FIELD_EX32(s->regs, STATUS_REGISTER, SLEEP))) {
|
|
/*
|
|
* XlnxVersalCANFDState is in sleep mode. Any data on bus will bring
|
|
* it to the wake up state.
|
|
*/
|
|
canfd_exit_sleep_mode(s);
|
|
}
|
|
|
|
update_rx_sequential(s, frame);
|
|
}
|
|
|
|
/* Message processing done. Update the status back to !busy */
|
|
ARRAY_FIELD_DP32(s->regs, STATUS_REGISTER, BBSY, 0);
|
|
return 1;
|
|
}
|
|
|
|
static CanBusClientInfo canfd_xilinx_bus_client_info = {
|
|
.can_receive = can_xilinx_canfd_receive,
|
|
.receive = canfd_xilinx_receive,
|
|
};
|
|
|
|
static int xlnx_canfd_connect_to_bus(XlnxVersalCANFDState *s,
|
|
CanBusState *bus)
|
|
{
|
|
s->bus_client.info = &canfd_xilinx_bus_client_info;
|
|
|
|
return can_bus_insert_client(bus, &s->bus_client);
|
|
}
|
|
|
|
#define NUM_REG_PER_AF ARRAY_SIZE(canfd_af_regs)
|
|
#define NUM_AF 32
|
|
#define NUM_REG_PER_TXE ARRAY_SIZE(canfd_txe_regs)
|
|
#define NUM_TXE 32
|
|
|
|
static int canfd_populate_regarray(XlnxVersalCANFDState *s,
|
|
RegisterInfoArray *r_array, int pos,
|
|
const RegisterAccessInfo *rae,
|
|
int num_rae)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < num_rae; i++) {
|
|
int index = rae[i].addr / 4;
|
|
RegisterInfo *r = &s->reg_info[index];
|
|
|
|
object_initialize(r, sizeof(*r), TYPE_REGISTER);
|
|
|
|
*r = (RegisterInfo) {
|
|
.data = &s->regs[index],
|
|
.data_size = sizeof(uint32_t),
|
|
.access = &rae[i],
|
|
.opaque = OBJECT(s),
|
|
};
|
|
|
|
r_array->r[i + pos] = r;
|
|
}
|
|
return i + pos;
|
|
}
|
|
|
|
static void canfd_create_rai(RegisterAccessInfo *rai_array,
|
|
const RegisterAccessInfo *canfd_regs,
|
|
int template_rai_array_sz,
|
|
int num_template_to_copy)
|
|
{
|
|
int i;
|
|
int reg_num;
|
|
|
|
for (reg_num = 0; reg_num < num_template_to_copy; reg_num++) {
|
|
int pos = reg_num * template_rai_array_sz;
|
|
|
|
memcpy(rai_array + pos, canfd_regs,
|
|
template_rai_array_sz * sizeof(RegisterAccessInfo));
|
|
|
|
for (i = 0; i < template_rai_array_sz; i++) {
|
|
const char *name = canfd_regs[i].name;
|
|
uint64_t addr = canfd_regs[i].addr;
|
|
rai_array[i + pos].name = g_strdup_printf("%s%d", name, reg_num);
|
|
rai_array[i + pos].addr = addr + pos * 4;
|
|
}
|
|
}
|
|
}
|
|
|
|
static RegisterInfoArray *canfd_create_regarray(XlnxVersalCANFDState *s)
|
|
{
|
|
const char *device_prefix = object_get_typename(OBJECT(s));
|
|
uint64_t memory_size = XLNX_VERSAL_CANFD_R_MAX * 4;
|
|
int num_regs;
|
|
int pos = 0;
|
|
RegisterInfoArray *r_array;
|
|
|
|
num_regs = ARRAY_SIZE(canfd_regs_info) +
|
|
s->cfg.tx_fifo * NUM_REGS_PER_MSG_SPACE +
|
|
s->cfg.rx0_fifo * NUM_REGS_PER_MSG_SPACE +
|
|
NUM_AF * NUM_REG_PER_AF +
|
|
NUM_TXE * NUM_REG_PER_TXE;
|
|
|
|
s->tx_regs = g_new0(RegisterAccessInfo,
|
|
s->cfg.tx_fifo * ARRAY_SIZE(canfd_tx_regs));
|
|
|
|
canfd_create_rai(s->tx_regs, canfd_tx_regs,
|
|
ARRAY_SIZE(canfd_tx_regs), s->cfg.tx_fifo);
|
|
|
|
s->rx0_regs = g_new0(RegisterAccessInfo,
|
|
s->cfg.rx0_fifo * ARRAY_SIZE(canfd_rx0_regs));
|
|
|
|
canfd_create_rai(s->rx0_regs, canfd_rx0_regs,
|
|
ARRAY_SIZE(canfd_rx0_regs), s->cfg.rx0_fifo);
|
|
|
|
s->af_regs = g_new0(RegisterAccessInfo,
|
|
NUM_AF * ARRAY_SIZE(canfd_af_regs));
|
|
|
|
canfd_create_rai(s->af_regs, canfd_af_regs,
|
|
ARRAY_SIZE(canfd_af_regs), NUM_AF);
|
|
|
|
s->txe_regs = g_new0(RegisterAccessInfo,
|
|
NUM_TXE * ARRAY_SIZE(canfd_txe_regs));
|
|
|
|
canfd_create_rai(s->txe_regs, canfd_txe_regs,
|
|
ARRAY_SIZE(canfd_txe_regs), NUM_TXE);
|
|
|
|
if (s->cfg.enable_rx_fifo1) {
|
|
num_regs += s->cfg.rx1_fifo * NUM_REGS_PER_MSG_SPACE;
|
|
|
|
s->rx1_regs = g_new0(RegisterAccessInfo,
|
|
s->cfg.rx1_fifo * ARRAY_SIZE(canfd_rx1_regs));
|
|
|
|
canfd_create_rai(s->rx1_regs, canfd_rx1_regs,
|
|
ARRAY_SIZE(canfd_rx1_regs), s->cfg.rx1_fifo);
|
|
}
|
|
|
|
r_array = g_new0(RegisterInfoArray, 1);
|
|
r_array->r = g_new0(RegisterInfo * , num_regs);
|
|
r_array->num_elements = num_regs;
|
|
r_array->prefix = device_prefix;
|
|
|
|
pos = canfd_populate_regarray(s, r_array, pos,
|
|
canfd_regs_info,
|
|
ARRAY_SIZE(canfd_regs_info));
|
|
pos = canfd_populate_regarray(s, r_array, pos,
|
|
s->tx_regs, s->cfg.tx_fifo *
|
|
NUM_REGS_PER_MSG_SPACE);
|
|
pos = canfd_populate_regarray(s, r_array, pos,
|
|
s->rx0_regs, s->cfg.rx0_fifo *
|
|
NUM_REGS_PER_MSG_SPACE);
|
|
if (s->cfg.enable_rx_fifo1) {
|
|
pos = canfd_populate_regarray(s, r_array, pos,
|
|
s->rx1_regs, s->cfg.rx1_fifo *
|
|
NUM_REGS_PER_MSG_SPACE);
|
|
}
|
|
pos = canfd_populate_regarray(s, r_array, pos,
|
|
s->af_regs, NUM_AF * NUM_REG_PER_AF);
|
|
pos = canfd_populate_regarray(s, r_array, pos,
|
|
s->txe_regs, NUM_TXE * NUM_REG_PER_TXE);
|
|
|
|
memory_region_init_io(&r_array->mem, OBJECT(s), &canfd_ops, r_array,
|
|
device_prefix, memory_size);
|
|
return r_array;
|
|
}
|
|
|
|
static void canfd_realize(DeviceState *dev, Error **errp)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(dev);
|
|
RegisterInfoArray *reg_array;
|
|
|
|
reg_array = canfd_create_regarray(s);
|
|
memory_region_add_subregion(&s->iomem, 0x00, ®_array->mem);
|
|
sysbus_init_mmio(SYS_BUS_DEVICE(dev), &s->iomem);
|
|
sysbus_init_irq(SYS_BUS_DEVICE(dev), &s->irq_canfd_int);
|
|
|
|
if (s->canfdbus) {
|
|
if (xlnx_canfd_connect_to_bus(s, s->canfdbus) < 0) {
|
|
g_autofree char *path = object_get_canonical_path(OBJECT(s));
|
|
|
|
error_setg(errp, "%s: xlnx_canfd_connect_to_bus failed", path);
|
|
return;
|
|
}
|
|
|
|
}
|
|
|
|
/* Allocate a new timer. */
|
|
s->canfd_timer = ptimer_init(xlnx_versal_canfd_ptimer_cb, s,
|
|
PTIMER_POLICY_WRAP_AFTER_ONE_PERIOD |
|
|
PTIMER_POLICY_TRIGGER_ONLY_ON_DECREMENT |
|
|
PTIMER_POLICY_NO_IMMEDIATE_RELOAD);
|
|
|
|
ptimer_transaction_begin(s->canfd_timer);
|
|
|
|
ptimer_set_freq(s->canfd_timer, s->cfg.ext_clk_freq);
|
|
ptimer_set_limit(s->canfd_timer, CANFD_TIMER_MAX, 1);
|
|
ptimer_run(s->canfd_timer, 0);
|
|
ptimer_transaction_commit(s->canfd_timer);
|
|
}
|
|
|
|
static void canfd_init(Object *obj)
|
|
{
|
|
XlnxVersalCANFDState *s = XILINX_CANFD(obj);
|
|
|
|
memory_region_init(&s->iomem, obj, TYPE_XILINX_CANFD,
|
|
XLNX_VERSAL_CANFD_R_MAX * 4);
|
|
}
|
|
|
|
static const VMStateDescription vmstate_canfd = {
|
|
.name = TYPE_XILINX_CANFD,
|
|
.version_id = 1,
|
|
.minimum_version_id = 1,
|
|
.fields = (const VMStateField[]) {
|
|
VMSTATE_UINT32_ARRAY(regs, XlnxVersalCANFDState,
|
|
XLNX_VERSAL_CANFD_R_MAX),
|
|
VMSTATE_PTIMER(canfd_timer, XlnxVersalCANFDState),
|
|
VMSTATE_END_OF_LIST(),
|
|
}
|
|
};
|
|
|
|
static Property canfd_core_properties[] = {
|
|
DEFINE_PROP_UINT8("rx-fifo0", XlnxVersalCANFDState, cfg.rx0_fifo, 0x40),
|
|
DEFINE_PROP_UINT8("rx-fifo1", XlnxVersalCANFDState, cfg.rx1_fifo, 0x40),
|
|
DEFINE_PROP_UINT8("tx-fifo", XlnxVersalCANFDState, cfg.tx_fifo, 0x20),
|
|
DEFINE_PROP_BOOL("enable-rx-fifo1", XlnxVersalCANFDState,
|
|
cfg.enable_rx_fifo1, true),
|
|
DEFINE_PROP_UINT32("ext_clk_freq", XlnxVersalCANFDState, cfg.ext_clk_freq,
|
|
CANFD_DEFAULT_CLOCK),
|
|
DEFINE_PROP_LINK("canfdbus", XlnxVersalCANFDState, canfdbus, TYPE_CAN_BUS,
|
|
CanBusState *),
|
|
DEFINE_PROP_END_OF_LIST(),
|
|
};
|
|
|
|
static void canfd_class_init(ObjectClass *klass, void *data)
|
|
{
|
|
DeviceClass *dc = DEVICE_CLASS(klass);
|
|
|
|
dc->reset = canfd_reset;
|
|
dc->realize = canfd_realize;
|
|
device_class_set_props(dc, canfd_core_properties);
|
|
dc->vmsd = &vmstate_canfd;
|
|
}
|
|
|
|
static const TypeInfo canfd_info = {
|
|
.name = TYPE_XILINX_CANFD,
|
|
.parent = TYPE_SYS_BUS_DEVICE,
|
|
.instance_size = sizeof(XlnxVersalCANFDState),
|
|
.class_init = canfd_class_init,
|
|
.instance_init = canfd_init,
|
|
};
|
|
|
|
static void canfd_register_types(void)
|
|
{
|
|
type_register_static(&canfd_info);
|
|
}
|
|
|
|
type_init(canfd_register_types)
|