1aa406e8bSJan Charvat /* 2aa406e8bSJan Charvat * CTU CAN FD PCI device emulation 3aa406e8bSJan Charvat * http://canbus.pages.fel.cvut.cz/ 4aa406e8bSJan Charvat * 5aa406e8bSJan Charvat * Copyright (c) 2019 Jan Charvat (jancharvat.charvat@gmail.com) 6aa406e8bSJan Charvat * 7aa406e8bSJan Charvat * Based on Kvaser PCI CAN device (SJA1000 based) emulation implemented by 8aa406e8bSJan Charvat * Jin Yang and Pavel Pisa 9aa406e8bSJan Charvat * 10aa406e8bSJan Charvat * Permission is hereby granted, free of charge, to any person obtaining a copy 11aa406e8bSJan Charvat * of this software and associated documentation files (the "Software"), to deal 12aa406e8bSJan Charvat * in the Software without restriction, including without limitation the rights 13aa406e8bSJan Charvat * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 14aa406e8bSJan Charvat * copies of the Software, and to permit persons to whom the Software is 15aa406e8bSJan Charvat * furnished to do so, subject to the following conditions: 16aa406e8bSJan Charvat * 17aa406e8bSJan Charvat * The above copyright notice and this permission notice shall be included in 18aa406e8bSJan Charvat * all copies or substantial portions of the Software. 19aa406e8bSJan Charvat * 20aa406e8bSJan Charvat * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 21aa406e8bSJan Charvat * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 22aa406e8bSJan Charvat * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 23aa406e8bSJan Charvat * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 24aa406e8bSJan Charvat * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 25aa406e8bSJan Charvat * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 26aa406e8bSJan Charvat * THE SOFTWARE. 27aa406e8bSJan Charvat */ 28aa406e8bSJan Charvat 29aa406e8bSJan Charvat #include "qemu/osdep.h" 30aa406e8bSJan Charvat #include "qemu/log.h" 31aa406e8bSJan Charvat #include "chardev/char.h" 32aa406e8bSJan Charvat #include "hw/irq.h" 33aa406e8bSJan Charvat #include "migration/vmstate.h" 34aa406e8bSJan Charvat #include "net/can_emu.h" 35aa406e8bSJan Charvat 36aa406e8bSJan Charvat #include "ctucan_core.h" 37aa406e8bSJan Charvat 38aa406e8bSJan Charvat #ifndef DEBUG_CAN 39aa406e8bSJan Charvat #define DEBUG_CAN 0 40aa406e8bSJan Charvat #endif /*DEBUG_CAN*/ 41aa406e8bSJan Charvat 42aa406e8bSJan Charvat #define DPRINTF(fmt, ...) \ 43aa406e8bSJan Charvat do { \ 44aa406e8bSJan Charvat if (DEBUG_CAN) { \ 45aa406e8bSJan Charvat qemu_log("[ctucan]: " fmt , ## __VA_ARGS__); \ 46aa406e8bSJan Charvat } \ 47aa406e8bSJan Charvat } while (0) 48aa406e8bSJan Charvat 49aa406e8bSJan Charvat static void ctucan_buff2frame(const uint8_t *buff, qemu_can_frame *frame) 50aa406e8bSJan Charvat { 51aa406e8bSJan Charvat frame->can_id = 0; 52aa406e8bSJan Charvat frame->can_dlc = 0; 53aa406e8bSJan Charvat frame->flags = 0; 54aa406e8bSJan Charvat 55aa406e8bSJan Charvat if (buff == NULL) { 56aa406e8bSJan Charvat return; 57aa406e8bSJan Charvat } 58aa406e8bSJan Charvat { 59aa406e8bSJan Charvat union ctu_can_fd_frame_form_w frame_form_w; 60aa406e8bSJan Charvat union ctu_can_fd_identifier_w identifier_w; 61aa406e8bSJan Charvat unsigned int ide; 62aa406e8bSJan Charvat uint32_t w; 63aa406e8bSJan Charvat 64aa406e8bSJan Charvat w = le32_to_cpu(*(uint32_t *)buff); 65aa406e8bSJan Charvat frame_form_w = (union ctu_can_fd_frame_form_w)w; 66aa406e8bSJan Charvat frame->can_dlc = can_dlc2len(frame_form_w.s.dlc); 67aa406e8bSJan Charvat 68aa406e8bSJan Charvat w = le32_to_cpu(*(uint32_t *)(buff + 4)); 69aa406e8bSJan Charvat identifier_w = (union ctu_can_fd_identifier_w)w; 70aa406e8bSJan Charvat 71aa406e8bSJan Charvat ide = frame_form_w.s.ide; 72aa406e8bSJan Charvat if (ide) { 73aa406e8bSJan Charvat frame->can_id = (identifier_w.s.identifier_base << 18) | 74aa406e8bSJan Charvat identifier_w.s.identifier_ext; 75aa406e8bSJan Charvat frame->can_id |= QEMU_CAN_EFF_FLAG; 76aa406e8bSJan Charvat } else { 77aa406e8bSJan Charvat frame->can_id = identifier_w.s.identifier_base; 78aa406e8bSJan Charvat } 79aa406e8bSJan Charvat 80aa406e8bSJan Charvat if (frame_form_w.s.esi_rsv) { 81aa406e8bSJan Charvat frame->flags |= QEMU_CAN_FRMF_ESI; 82aa406e8bSJan Charvat } 83aa406e8bSJan Charvat 84aa406e8bSJan Charvat if (frame_form_w.s.rtr) { 85aa406e8bSJan Charvat frame->can_id |= QEMU_CAN_RTR_FLAG; 86aa406e8bSJan Charvat } 87aa406e8bSJan Charvat 88aa406e8bSJan Charvat if (frame_form_w.s.fdf) { /*CAN FD*/ 89aa406e8bSJan Charvat frame->flags |= QEMU_CAN_FRMF_TYPE_FD; 90aa406e8bSJan Charvat if (frame_form_w.s.brs) { 91aa406e8bSJan Charvat frame->flags |= QEMU_CAN_FRMF_BRS; 92aa406e8bSJan Charvat } 93aa406e8bSJan Charvat } 94aa406e8bSJan Charvat } 95aa406e8bSJan Charvat 96aa406e8bSJan Charvat memcpy(frame->data, buff + 0x10, 0x40); 97aa406e8bSJan Charvat } 98aa406e8bSJan Charvat 99aa406e8bSJan Charvat 100aa406e8bSJan Charvat static int ctucan_frame2buff(const qemu_can_frame *frame, uint8_t *buff) 101aa406e8bSJan Charvat { 102aa406e8bSJan Charvat unsigned int bytes_cnt = -1; 103aa406e8bSJan Charvat memset(buff, 0, CTUCAN_MSG_MAX_LEN * sizeof(*buff)); 104aa406e8bSJan Charvat 105aa406e8bSJan Charvat if (frame == NULL) { 106aa406e8bSJan Charvat return bytes_cnt; 107aa406e8bSJan Charvat } 108aa406e8bSJan Charvat { 109aa406e8bSJan Charvat union ctu_can_fd_frame_form_w frame_form_w; 110aa406e8bSJan Charvat union ctu_can_fd_identifier_w identifier_w; 111aa406e8bSJan Charvat 112aa406e8bSJan Charvat frame_form_w.u32 = 0; 113aa406e8bSJan Charvat identifier_w.u32 = 0; 114aa406e8bSJan Charvat 115aa406e8bSJan Charvat bytes_cnt = frame->can_dlc; 116aa406e8bSJan Charvat bytes_cnt = (bytes_cnt + 3) & ~3; 117aa406e8bSJan Charvat bytes_cnt += 16; 118aa406e8bSJan Charvat frame_form_w.s.rwcnt = (bytes_cnt >> 2) - 1; 119aa406e8bSJan Charvat 120aa406e8bSJan Charvat frame_form_w.s.dlc = can_len2dlc(frame->can_dlc); 121aa406e8bSJan Charvat 122aa406e8bSJan Charvat if (frame->can_id & QEMU_CAN_EFF_FLAG) { 123aa406e8bSJan Charvat frame_form_w.s.ide = 1; 124aa406e8bSJan Charvat identifier_w.s.identifier_base = 125aa406e8bSJan Charvat (frame->can_id & 0x1FFC0000) >> 18; 126aa406e8bSJan Charvat identifier_w.s.identifier_ext = frame->can_id & 0x3FFFF; 127aa406e8bSJan Charvat } else { 128aa406e8bSJan Charvat identifier_w.s.identifier_base = frame->can_id & 0x7FF; 129aa406e8bSJan Charvat } 130aa406e8bSJan Charvat 131aa406e8bSJan Charvat if (frame->flags & QEMU_CAN_FRMF_ESI) { 132aa406e8bSJan Charvat frame_form_w.s.esi_rsv = 1; 133aa406e8bSJan Charvat } 134aa406e8bSJan Charvat 135aa406e8bSJan Charvat if (frame->can_id & QEMU_CAN_RTR_FLAG) { 136aa406e8bSJan Charvat frame_form_w.s.rtr = 1; 137aa406e8bSJan Charvat } 138aa406e8bSJan Charvat 139aa406e8bSJan Charvat if (frame->flags & QEMU_CAN_FRMF_TYPE_FD) { /*CAN FD*/ 140aa406e8bSJan Charvat frame_form_w.s.fdf = 1; 141aa406e8bSJan Charvat if (frame->flags & QEMU_CAN_FRMF_BRS) { 142aa406e8bSJan Charvat frame_form_w.s.brs = 1; 143aa406e8bSJan Charvat } 144aa406e8bSJan Charvat } 145aa406e8bSJan Charvat *(uint32_t *)buff = cpu_to_le32(frame_form_w.u32); 146aa406e8bSJan Charvat *(uint32_t *)(buff + 4) = cpu_to_le32(identifier_w.u32); 147aa406e8bSJan Charvat } 148aa406e8bSJan Charvat 149aa406e8bSJan Charvat memcpy(buff + 0x10, frame->data, 0x40); 150aa406e8bSJan Charvat 151aa406e8bSJan Charvat return bytes_cnt; 152aa406e8bSJan Charvat } 153aa406e8bSJan Charvat 154aa406e8bSJan Charvat static void ctucan_update_irq(CtuCanCoreState *s) 155aa406e8bSJan Charvat { 156aa406e8bSJan Charvat union ctu_can_fd_int_stat int_rq; 157aa406e8bSJan Charvat 158aa406e8bSJan Charvat int_rq.u32 = 0; 159aa406e8bSJan Charvat 160aa406e8bSJan Charvat if (s->rx_status_rx_settings.s.rxfrc) { 161aa406e8bSJan Charvat int_rq.s.rbnei = 1; 162aa406e8bSJan Charvat } 163aa406e8bSJan Charvat 164aa406e8bSJan Charvat int_rq.u32 &= ~s->int_mask.u32; 165aa406e8bSJan Charvat s->int_stat.u32 |= int_rq.u32; 166aa406e8bSJan Charvat if (s->int_stat.u32 & s->int_ena.u32) { 167aa406e8bSJan Charvat qemu_irq_raise(s->irq); 168aa406e8bSJan Charvat } else { 169aa406e8bSJan Charvat qemu_irq_lower(s->irq); 170aa406e8bSJan Charvat } 171aa406e8bSJan Charvat } 172aa406e8bSJan Charvat 173aa406e8bSJan Charvat static void ctucan_update_txnf(CtuCanCoreState *s) 174aa406e8bSJan Charvat { 175aa406e8bSJan Charvat int i; 176aa406e8bSJan Charvat int txnf; 177aa406e8bSJan Charvat unsigned int buff_st; 178aa406e8bSJan Charvat 179aa406e8bSJan Charvat txnf = 0; 180aa406e8bSJan Charvat 181aa406e8bSJan Charvat for (i = 0; i < CTUCAN_CORE_TXBUF_NUM; i++) { 182aa406e8bSJan Charvat buff_st = (s->tx_status.u32 >> (i * 4)) & 0xf; 183aa406e8bSJan Charvat if (buff_st == TXT_ETY) { 184aa406e8bSJan Charvat txnf = 1; 185aa406e8bSJan Charvat } 186aa406e8bSJan Charvat } 187aa406e8bSJan Charvat s->status.s.txnf = txnf; 188aa406e8bSJan Charvat } 189aa406e8bSJan Charvat 190aa406e8bSJan Charvat void ctucan_hardware_reset(CtuCanCoreState *s) 191aa406e8bSJan Charvat { 192aa406e8bSJan Charvat DPRINTF("Hardware reset in progress!!!\n"); 193aa406e8bSJan Charvat int i; 194aa406e8bSJan Charvat unsigned int buff_st; 195aa406e8bSJan Charvat uint32_t buff_st_mask; 196aa406e8bSJan Charvat 197aa406e8bSJan Charvat s->tx_status.u32 = 0; 198aa406e8bSJan Charvat for (i = 0; i < CTUCAN_CORE_TXBUF_NUM; i++) { 199aa406e8bSJan Charvat buff_st_mask = 0xf << (i * 4); 200aa406e8bSJan Charvat buff_st = TXT_ETY; 201aa406e8bSJan Charvat s->tx_status.u32 = (s->tx_status.u32 & ~buff_st_mask) | 202aa406e8bSJan Charvat (buff_st << (i * 4)); 203aa406e8bSJan Charvat } 204aa406e8bSJan Charvat s->status.s.idle = 1; 205aa406e8bSJan Charvat 206aa406e8bSJan Charvat ctucan_update_txnf(s); 207aa406e8bSJan Charvat 208aa406e8bSJan Charvat s->rx_status_rx_settings.u32 = 0; 209aa406e8bSJan Charvat s->rx_tail_pos = 0; 210aa406e8bSJan Charvat s->rx_cnt = 0; 211aa406e8bSJan Charvat s->rx_frame_rem = 0; 212aa406e8bSJan Charvat 213aa406e8bSJan Charvat /* Flush RX buffer */ 214aa406e8bSJan Charvat s->rx_tail_pos = 0; 215aa406e8bSJan Charvat s->rx_cnt = 0; 216aa406e8bSJan Charvat s->rx_frame_rem = 0; 217aa406e8bSJan Charvat 218aa406e8bSJan Charvat /* Set on progdokum reset value */ 219aa406e8bSJan Charvat s->mode_settings.u32 = 0; 220aa406e8bSJan Charvat s->mode_settings.s.fde = 1; 221aa406e8bSJan Charvat 222aa406e8bSJan Charvat s->int_stat.u32 = 0; 223aa406e8bSJan Charvat s->int_ena.u32 = 0; 224aa406e8bSJan Charvat s->int_mask.u32 = 0; 225aa406e8bSJan Charvat 226aa406e8bSJan Charvat s->rx_status_rx_settings.u32 = 0; 227aa406e8bSJan Charvat s->rx_status_rx_settings.s.rxe = 0; 228aa406e8bSJan Charvat 229aa406e8bSJan Charvat s->rx_fr_ctr.u32 = 0; 230aa406e8bSJan Charvat s->tx_fr_ctr.u32 = 0; 231aa406e8bSJan Charvat 232aa406e8bSJan Charvat s->yolo_reg.s.yolo_val = 3735928559; 233aa406e8bSJan Charvat 234aa406e8bSJan Charvat qemu_irq_lower(s->irq); 235aa406e8bSJan Charvat } 236aa406e8bSJan Charvat 237aa406e8bSJan Charvat static void ctucan_send_ready_buffers(CtuCanCoreState *s) 238aa406e8bSJan Charvat { 239aa406e8bSJan Charvat qemu_can_frame frame; 240aa406e8bSJan Charvat uint8_t *pf; 241aa406e8bSJan Charvat int buff2tx_idx; 242aa406e8bSJan Charvat uint32_t tx_prio_max; 243aa406e8bSJan Charvat 244aa406e8bSJan Charvat if (!s->mode_settings.s.ena) { 245aa406e8bSJan Charvat return; 246aa406e8bSJan Charvat } 247aa406e8bSJan Charvat 248aa406e8bSJan Charvat do { 249aa406e8bSJan Charvat union ctu_can_fd_int_stat int_stat; 250aa406e8bSJan Charvat int i; 251aa406e8bSJan Charvat buff2tx_idx = -1; 252aa406e8bSJan Charvat tx_prio_max = 0; 253aa406e8bSJan Charvat 254aa406e8bSJan Charvat for (i = 0; i < CTUCAN_CORE_TXBUF_NUM; i++) { 255aa406e8bSJan Charvat uint32_t prio; 256aa406e8bSJan Charvat 257e0784d83SPeter Maydell if (extract32(s->tx_status.u32, i * 4, 4) != TXT_RDY) { 258aa406e8bSJan Charvat continue; 259aa406e8bSJan Charvat } 260aa406e8bSJan Charvat prio = (s->tx_priority.u32 >> (i * 4)) & 0x7; 261aa406e8bSJan Charvat if (tx_prio_max < prio) { 262aa406e8bSJan Charvat tx_prio_max = prio; 263aa406e8bSJan Charvat buff2tx_idx = i; 264aa406e8bSJan Charvat } 265aa406e8bSJan Charvat } 266aa406e8bSJan Charvat if (buff2tx_idx == -1) { 267aa406e8bSJan Charvat break; 268aa406e8bSJan Charvat } 269aa406e8bSJan Charvat int_stat.u32 = 0; 270aa406e8bSJan Charvat pf = s->tx_buffer[buff2tx_idx].data; 271aa406e8bSJan Charvat ctucan_buff2frame(pf, &frame); 272aa406e8bSJan Charvat s->status.s.idle = 0; 273aa406e8bSJan Charvat s->status.s.txs = 1; 274aa406e8bSJan Charvat can_bus_client_send(&s->bus_client, &frame, 1); 275aa406e8bSJan Charvat s->status.s.idle = 1; 276aa406e8bSJan Charvat s->status.s.txs = 0; 277aa406e8bSJan Charvat s->tx_fr_ctr.s.tx_fr_ctr_val++; 278aa406e8bSJan Charvat int_stat.s.txi = 1; 279aa406e8bSJan Charvat int_stat.s.txbhci = 1; 280aa406e8bSJan Charvat s->int_stat.u32 |= int_stat.u32 & ~s->int_mask.u32; 281e0784d83SPeter Maydell s->tx_status.u32 = deposit32(s->tx_status.u32, 282e0784d83SPeter Maydell buff2tx_idx * 4, 4, TXT_TOK); 283aa406e8bSJan Charvat } while (1); 284aa406e8bSJan Charvat } 285aa406e8bSJan Charvat 286aa406e8bSJan Charvat #define CTUCAN_CORE_TXBUFF_SPAN \ 287aa406e8bSJan Charvat (CTU_CAN_FD_TXTB2_DATA_1 - CTU_CAN_FD_TXTB1_DATA_1) 288aa406e8bSJan Charvat 289aa406e8bSJan Charvat void ctucan_mem_write(CtuCanCoreState *s, hwaddr addr, uint64_t val, 290aa406e8bSJan Charvat unsigned size) 291aa406e8bSJan Charvat { 292aa406e8bSJan Charvat int i; 293aa406e8bSJan Charvat 294aa406e8bSJan Charvat DPRINTF("write 0x%02llx addr 0x%02x\n", 295aa406e8bSJan Charvat (unsigned long long)val, (unsigned int)addr); 296aa406e8bSJan Charvat 2975e73953aSPeter Maydell if (addr >= CTUCAN_CORE_MEM_SIZE) { 298aa406e8bSJan Charvat return; 299aa406e8bSJan Charvat } 300aa406e8bSJan Charvat 301aa406e8bSJan Charvat if (addr >= CTU_CAN_FD_TXTB1_DATA_1) { 302aa406e8bSJan Charvat int buff_num; 303aa406e8bSJan Charvat addr -= CTU_CAN_FD_TXTB1_DATA_1; 304aa406e8bSJan Charvat buff_num = addr / CTUCAN_CORE_TXBUFF_SPAN; 305aa406e8bSJan Charvat addr %= CTUCAN_CORE_TXBUFF_SPAN; 3065e73953aSPeter Maydell if ((buff_num < CTUCAN_CORE_TXBUF_NUM) && 30771182187SPeter Maydell ((addr + size) <= sizeof(s->tx_buffer[buff_num].data))) { 30871182187SPeter Maydell stn_le_p(s->tx_buffer[buff_num].data + addr, size, val); 309aa406e8bSJan Charvat } 310aa406e8bSJan Charvat } else { 311aa406e8bSJan Charvat switch (addr & ~3) { 312aa406e8bSJan Charvat case CTU_CAN_FD_MODE: 313aa406e8bSJan Charvat s->mode_settings.u32 = (uint32_t)val; 314aa406e8bSJan Charvat if (s->mode_settings.s.rst) { 315aa406e8bSJan Charvat ctucan_hardware_reset(s); 316aa406e8bSJan Charvat s->mode_settings.s.rst = 0; 317aa406e8bSJan Charvat } 318aa406e8bSJan Charvat break; 319aa406e8bSJan Charvat case CTU_CAN_FD_COMMAND: 320aa406e8bSJan Charvat { 321aa406e8bSJan Charvat union ctu_can_fd_command command; 322aa406e8bSJan Charvat command.u32 = (uint32_t)val; 323aa406e8bSJan Charvat if (command.s.cdo) { 324aa406e8bSJan Charvat s->status.s.dor = 0; 325aa406e8bSJan Charvat } 326aa406e8bSJan Charvat if (command.s.rrb) { 327aa406e8bSJan Charvat s->rx_tail_pos = 0; 328aa406e8bSJan Charvat s->rx_cnt = 0; 329aa406e8bSJan Charvat s->rx_frame_rem = 0; 330aa406e8bSJan Charvat s->rx_status_rx_settings.s.rxfrc = 0; 331aa406e8bSJan Charvat } 332aa406e8bSJan Charvat if (command.s.txfcrst) { 333aa406e8bSJan Charvat s->tx_fr_ctr.s.tx_fr_ctr_val = 0; 334aa406e8bSJan Charvat } 335aa406e8bSJan Charvat if (command.s.rxfcrst) { 336aa406e8bSJan Charvat s->rx_fr_ctr.s.rx_fr_ctr_val = 0; 337aa406e8bSJan Charvat } 338aa406e8bSJan Charvat break; 339aa406e8bSJan Charvat } 340aa406e8bSJan Charvat case CTU_CAN_FD_INT_STAT: 341aa406e8bSJan Charvat s->int_stat.u32 &= ~(uint32_t)val; 342aa406e8bSJan Charvat break; 343aa406e8bSJan Charvat case CTU_CAN_FD_INT_ENA_SET: 344aa406e8bSJan Charvat s->int_ena.u32 |= (uint32_t)val; 345aa406e8bSJan Charvat break; 346aa406e8bSJan Charvat case CTU_CAN_FD_INT_ENA_CLR: 347aa406e8bSJan Charvat s->int_ena.u32 &= ~(uint32_t)val; 348aa406e8bSJan Charvat break; 349aa406e8bSJan Charvat case CTU_CAN_FD_INT_MASK_SET: 350aa406e8bSJan Charvat s->int_mask.u32 |= (uint32_t)val; 351aa406e8bSJan Charvat break; 352aa406e8bSJan Charvat case CTU_CAN_FD_INT_MASK_CLR: 353aa406e8bSJan Charvat s->int_mask.u32 &= ~(uint32_t)val; 354aa406e8bSJan Charvat break; 355aa406e8bSJan Charvat case CTU_CAN_FD_TX_COMMAND: 356aa406e8bSJan Charvat if (s->mode_settings.s.ena) { 357aa406e8bSJan Charvat union ctu_can_fd_tx_command tx_command; 358aa406e8bSJan Charvat union ctu_can_fd_tx_command mask; 359aa406e8bSJan Charvat unsigned int buff_st; 360aa406e8bSJan Charvat uint32_t buff_st_mask; 361aa406e8bSJan Charvat 362aa406e8bSJan Charvat tx_command.u32 = (uint32_t)val; 363aa406e8bSJan Charvat mask.u32 = 0; 364aa406e8bSJan Charvat mask.s.txb1 = 1; 365aa406e8bSJan Charvat 366aa406e8bSJan Charvat for (i = 0; i < CTUCAN_CORE_TXBUF_NUM; i++) { 367aa406e8bSJan Charvat if (!(tx_command.u32 & (mask.u32 << i))) { 368aa406e8bSJan Charvat continue; 369aa406e8bSJan Charvat } 370aa406e8bSJan Charvat buff_st_mask = 0xf << (i * 4); 371aa406e8bSJan Charvat buff_st = (s->tx_status.u32 >> (i * 4)) & 0xf; 372aa406e8bSJan Charvat if (tx_command.s.txca) { 373aa406e8bSJan Charvat if (buff_st == TXT_RDY) { 374aa406e8bSJan Charvat buff_st = TXT_ABT; 375aa406e8bSJan Charvat } 376aa406e8bSJan Charvat } 377aa406e8bSJan Charvat if (tx_command.s.txcr) { 378aa406e8bSJan Charvat if ((buff_st == TXT_TOK) || (buff_st == TXT_ERR) || 379aa406e8bSJan Charvat (buff_st == TXT_ABT) || (buff_st == TXT_ETY)) 380aa406e8bSJan Charvat buff_st = TXT_RDY; 381aa406e8bSJan Charvat } 382aa406e8bSJan Charvat if (tx_command.s.txce) { 383aa406e8bSJan Charvat if ((buff_st == TXT_TOK) || (buff_st == TXT_ERR) || 384aa406e8bSJan Charvat (buff_st == TXT_ABT)) 385aa406e8bSJan Charvat buff_st = TXT_ETY; 386aa406e8bSJan Charvat } 387aa406e8bSJan Charvat s->tx_status.u32 = (s->tx_status.u32 & ~buff_st_mask) | 388aa406e8bSJan Charvat (buff_st << (i * 4)); 389aa406e8bSJan Charvat } 390aa406e8bSJan Charvat 391aa406e8bSJan Charvat ctucan_send_ready_buffers(s); 392aa406e8bSJan Charvat ctucan_update_txnf(s); 393aa406e8bSJan Charvat } 394aa406e8bSJan Charvat break; 395aa406e8bSJan Charvat case CTU_CAN_FD_TX_PRIORITY: 396aa406e8bSJan Charvat s->tx_priority.u32 = (uint32_t)val; 397aa406e8bSJan Charvat break; 398aa406e8bSJan Charvat } 399aa406e8bSJan Charvat 400aa406e8bSJan Charvat ctucan_update_irq(s); 401aa406e8bSJan Charvat } 402aa406e8bSJan Charvat 403aa406e8bSJan Charvat return; 404aa406e8bSJan Charvat } 405aa406e8bSJan Charvat 406aa406e8bSJan Charvat uint64_t ctucan_mem_read(CtuCanCoreState *s, hwaddr addr, unsigned size) 407aa406e8bSJan Charvat { 408aa406e8bSJan Charvat uint32_t val = 0; 409aa406e8bSJan Charvat 410aa406e8bSJan Charvat DPRINTF("read addr 0x%02x ...\n", (unsigned int)addr); 411aa406e8bSJan Charvat 412aa406e8bSJan Charvat if (addr > CTUCAN_CORE_MEM_SIZE) { 413aa406e8bSJan Charvat return 0; 414aa406e8bSJan Charvat } 415aa406e8bSJan Charvat 416aa406e8bSJan Charvat switch (addr & ~3) { 417aa406e8bSJan Charvat case CTU_CAN_FD_DEVICE_ID: 418aa406e8bSJan Charvat { 419aa406e8bSJan Charvat union ctu_can_fd_device_id_version idver; 420aa406e8bSJan Charvat idver.u32 = 0; 421aa406e8bSJan Charvat idver.s.device_id = CTU_CAN_FD_ID; 422aa406e8bSJan Charvat idver.s.ver_major = 2; 423aa406e8bSJan Charvat idver.s.ver_minor = 2; 424aa406e8bSJan Charvat val = idver.u32; 425aa406e8bSJan Charvat } 426aa406e8bSJan Charvat break; 427aa406e8bSJan Charvat case CTU_CAN_FD_MODE: 428aa406e8bSJan Charvat val = s->mode_settings.u32; 429aa406e8bSJan Charvat break; 430aa406e8bSJan Charvat case CTU_CAN_FD_STATUS: 431aa406e8bSJan Charvat val = s->status.u32; 432aa406e8bSJan Charvat break; 433aa406e8bSJan Charvat case CTU_CAN_FD_INT_STAT: 434aa406e8bSJan Charvat val = s->int_stat.u32; 435aa406e8bSJan Charvat break; 436aa406e8bSJan Charvat case CTU_CAN_FD_INT_ENA_SET: 437aa406e8bSJan Charvat case CTU_CAN_FD_INT_ENA_CLR: 438aa406e8bSJan Charvat val = s->int_ena.u32; 439aa406e8bSJan Charvat break; 440aa406e8bSJan Charvat case CTU_CAN_FD_INT_MASK_SET: 441aa406e8bSJan Charvat case CTU_CAN_FD_INT_MASK_CLR: 442aa406e8bSJan Charvat val = s->int_mask.u32; 443aa406e8bSJan Charvat break; 444aa406e8bSJan Charvat case CTU_CAN_FD_RX_MEM_INFO: 445aa406e8bSJan Charvat s->rx_mem_info.u32 = 0; 446aa406e8bSJan Charvat s->rx_mem_info.s.rx_buff_size = CTUCAN_RCV_BUF_LEN >> 2; 447aa406e8bSJan Charvat s->rx_mem_info.s.rx_mem_free = (CTUCAN_RCV_BUF_LEN - 448aa406e8bSJan Charvat s->rx_cnt) >> 2; 449aa406e8bSJan Charvat val = s->rx_mem_info.u32; 450aa406e8bSJan Charvat break; 451aa406e8bSJan Charvat case CTU_CAN_FD_RX_POINTERS: 452aa406e8bSJan Charvat { 453aa406e8bSJan Charvat uint32_t rx_head_pos = s->rx_tail_pos + s->rx_cnt; 454aa406e8bSJan Charvat rx_head_pos %= CTUCAN_RCV_BUF_LEN; 455aa406e8bSJan Charvat s->rx_pointers.s.rx_wpp = rx_head_pos; 456aa406e8bSJan Charvat s->rx_pointers.s.rx_rpp = s->rx_tail_pos; 457aa406e8bSJan Charvat val = s->rx_pointers.u32; 458aa406e8bSJan Charvat break; 459aa406e8bSJan Charvat } 460aa406e8bSJan Charvat case CTU_CAN_FD_RX_STATUS: 461aa406e8bSJan Charvat case CTU_CAN_FD_RX_SETTINGS: 462aa406e8bSJan Charvat if (!s->rx_status_rx_settings.s.rxfrc) { 463aa406e8bSJan Charvat s->rx_status_rx_settings.s.rxe = 1; 464aa406e8bSJan Charvat } else { 465aa406e8bSJan Charvat s->rx_status_rx_settings.s.rxe = 0; 466aa406e8bSJan Charvat } 467aa406e8bSJan Charvat if (((s->rx_cnt + 3) & ~3) == CTUCAN_RCV_BUF_LEN) { 468aa406e8bSJan Charvat s->rx_status_rx_settings.s.rxf = 1; 469aa406e8bSJan Charvat } else { 470aa406e8bSJan Charvat s->rx_status_rx_settings.s.rxf = 0; 471aa406e8bSJan Charvat } 472aa406e8bSJan Charvat val = s->rx_status_rx_settings.u32; 473aa406e8bSJan Charvat break; 474aa406e8bSJan Charvat case CTU_CAN_FD_RX_DATA: 475aa406e8bSJan Charvat if (s->rx_cnt) { 476aa406e8bSJan Charvat memcpy(&val, s->rx_buff + s->rx_tail_pos, 4); 477aa406e8bSJan Charvat val = le32_to_cpu(val); 478aa406e8bSJan Charvat if (!s->rx_frame_rem) { 479aa406e8bSJan Charvat union ctu_can_fd_frame_form_w frame_form_w; 480aa406e8bSJan Charvat frame_form_w.u32 = val; 481aa406e8bSJan Charvat s->rx_frame_rem = frame_form_w.s.rwcnt * 4 + 4; 482aa406e8bSJan Charvat } 483aa406e8bSJan Charvat s->rx_cnt -= 4; 484aa406e8bSJan Charvat s->rx_frame_rem -= 4; 485aa406e8bSJan Charvat if (!s->rx_frame_rem) { 486aa406e8bSJan Charvat s->rx_status_rx_settings.s.rxfrc--; 487aa406e8bSJan Charvat if (!s->rx_status_rx_settings.s.rxfrc) { 488aa406e8bSJan Charvat s->status.s.rxne = 0; 489aa406e8bSJan Charvat s->status.s.idle = 1; 490aa406e8bSJan Charvat s->status.s.rxs = 0; 491aa406e8bSJan Charvat } 492aa406e8bSJan Charvat } 493aa406e8bSJan Charvat s->rx_tail_pos = (s->rx_tail_pos + 4) % CTUCAN_RCV_BUF_LEN; 494aa406e8bSJan Charvat } else { 495aa406e8bSJan Charvat val = 0; 496aa406e8bSJan Charvat } 497aa406e8bSJan Charvat break; 498aa406e8bSJan Charvat case CTU_CAN_FD_TX_STATUS: 499aa406e8bSJan Charvat val = s->tx_status.u32; 500aa406e8bSJan Charvat break; 501aa406e8bSJan Charvat case CTU_CAN_FD_TX_PRIORITY: 502aa406e8bSJan Charvat val = s->tx_priority.u32; 503aa406e8bSJan Charvat break; 504aa406e8bSJan Charvat case CTU_CAN_FD_RX_FR_CTR: 505aa406e8bSJan Charvat val = s->rx_fr_ctr.s.rx_fr_ctr_val; 506aa406e8bSJan Charvat break; 507aa406e8bSJan Charvat case CTU_CAN_FD_TX_FR_CTR: 508aa406e8bSJan Charvat val = s->tx_fr_ctr.s.tx_fr_ctr_val; 509aa406e8bSJan Charvat break; 510aa406e8bSJan Charvat case CTU_CAN_FD_YOLO_REG: 511aa406e8bSJan Charvat val = s->yolo_reg.s.yolo_val; 512aa406e8bSJan Charvat break; 513aa406e8bSJan Charvat } 514aa406e8bSJan Charvat 515aa406e8bSJan Charvat val >>= ((addr & 3) << 3); 516aa406e8bSJan Charvat if (size < 8) { 517aa406e8bSJan Charvat val &= ((uint64_t)1 << (size << 3)) - 1; 518aa406e8bSJan Charvat } 519aa406e8bSJan Charvat 520aa406e8bSJan Charvat return val; 521aa406e8bSJan Charvat } 522aa406e8bSJan Charvat 523aa406e8bSJan Charvat bool ctucan_can_receive(CanBusClientState *client) 524aa406e8bSJan Charvat { 525aa406e8bSJan Charvat CtuCanCoreState *s = container_of(client, CtuCanCoreState, bus_client); 526aa406e8bSJan Charvat 527aa406e8bSJan Charvat if (!s->mode_settings.s.ena) { 528aa406e8bSJan Charvat return false; 529aa406e8bSJan Charvat } 530aa406e8bSJan Charvat 531aa406e8bSJan Charvat return true; /* always return true, when operation mode */ 532aa406e8bSJan Charvat } 533aa406e8bSJan Charvat 534aa406e8bSJan Charvat ssize_t ctucan_receive(CanBusClientState *client, const qemu_can_frame *frames, 535aa406e8bSJan Charvat size_t frames_cnt) 536aa406e8bSJan Charvat { 537aa406e8bSJan Charvat CtuCanCoreState *s = container_of(client, CtuCanCoreState, bus_client); 538aa406e8bSJan Charvat static uint8_t rcv[CTUCAN_MSG_MAX_LEN]; 539aa406e8bSJan Charvat int i; 540aa406e8bSJan Charvat int ret = -1; 541aa406e8bSJan Charvat const qemu_can_frame *frame = frames; 542aa406e8bSJan Charvat union ctu_can_fd_int_stat int_stat; 543aa406e8bSJan Charvat int_stat.u32 = 0; 544aa406e8bSJan Charvat 545aa406e8bSJan Charvat if (frames_cnt <= 0) { 546aa406e8bSJan Charvat return 0; 547aa406e8bSJan Charvat } 548aa406e8bSJan Charvat 549aa406e8bSJan Charvat ret = ctucan_frame2buff(frame, rcv); 550aa406e8bSJan Charvat 551aa406e8bSJan Charvat if (s->rx_cnt + ret > CTUCAN_RCV_BUF_LEN) { /* Data overrun. */ 552aa406e8bSJan Charvat s->status.s.dor = 1; 553aa406e8bSJan Charvat int_stat.s.doi = 1; 554aa406e8bSJan Charvat s->int_stat.u32 |= int_stat.u32 & ~s->int_mask.u32; 555aa406e8bSJan Charvat ctucan_update_irq(s); 556aa406e8bSJan Charvat DPRINTF("Receive FIFO overrun\n"); 557aa406e8bSJan Charvat return ret; 558aa406e8bSJan Charvat } 559aa406e8bSJan Charvat s->status.s.idle = 0; 560aa406e8bSJan Charvat s->status.s.rxs = 1; 561aa406e8bSJan Charvat int_stat.s.rxi = 1; 562aa406e8bSJan Charvat if (((s->rx_cnt + 3) & ~3) == CTUCAN_RCV_BUF_LEN) { 563aa406e8bSJan Charvat int_stat.s.rxfi = 1; 564aa406e8bSJan Charvat } 565aa406e8bSJan Charvat s->int_stat.u32 |= int_stat.u32 & ~s->int_mask.u32; 566aa406e8bSJan Charvat s->rx_fr_ctr.s.rx_fr_ctr_val++; 567aa406e8bSJan Charvat s->rx_status_rx_settings.s.rxfrc++; 568aa406e8bSJan Charvat for (i = 0; i < ret; i++) { 569aa406e8bSJan Charvat s->rx_buff[(s->rx_tail_pos + s->rx_cnt) % CTUCAN_RCV_BUF_LEN] = rcv[i]; 570aa406e8bSJan Charvat s->rx_cnt++; 571aa406e8bSJan Charvat } 572aa406e8bSJan Charvat s->status.s.rxne = 1; 573aa406e8bSJan Charvat 574aa406e8bSJan Charvat ctucan_update_irq(s); 575aa406e8bSJan Charvat 576aa406e8bSJan Charvat return 1; 577aa406e8bSJan Charvat } 578aa406e8bSJan Charvat 579aa406e8bSJan Charvat static CanBusClientInfo ctucan_bus_client_info = { 580aa406e8bSJan Charvat .can_receive = ctucan_can_receive, 581aa406e8bSJan Charvat .receive = ctucan_receive, 582aa406e8bSJan Charvat }; 583aa406e8bSJan Charvat 584aa406e8bSJan Charvat 585aa406e8bSJan Charvat int ctucan_connect_to_bus(CtuCanCoreState *s, CanBusState *bus) 586aa406e8bSJan Charvat { 587aa406e8bSJan Charvat s->bus_client.info = &ctucan_bus_client_info; 588aa406e8bSJan Charvat 589aa406e8bSJan Charvat if (!bus) { 590aa406e8bSJan Charvat return -EINVAL; 591aa406e8bSJan Charvat } 592aa406e8bSJan Charvat 593aa406e8bSJan Charvat if (can_bus_insert_client(bus, &s->bus_client) < 0) { 594aa406e8bSJan Charvat return -1; 595aa406e8bSJan Charvat } 596aa406e8bSJan Charvat 597aa406e8bSJan Charvat return 0; 598aa406e8bSJan Charvat } 599aa406e8bSJan Charvat 600aa406e8bSJan Charvat void ctucan_disconnect(CtuCanCoreState *s) 601aa406e8bSJan Charvat { 602aa406e8bSJan Charvat can_bus_remove_client(&s->bus_client); 603aa406e8bSJan Charvat } 604aa406e8bSJan Charvat 605aa406e8bSJan Charvat int ctucan_init(CtuCanCoreState *s, qemu_irq irq) 606aa406e8bSJan Charvat { 607aa406e8bSJan Charvat s->irq = irq; 608aa406e8bSJan Charvat 609aa406e8bSJan Charvat qemu_irq_lower(s->irq); 610aa406e8bSJan Charvat 611aa406e8bSJan Charvat ctucan_hardware_reset(s); 612aa406e8bSJan Charvat 613aa406e8bSJan Charvat return 0; 614aa406e8bSJan Charvat } 615aa406e8bSJan Charvat 616aa406e8bSJan Charvat const VMStateDescription vmstate_qemu_ctucan_tx_buffer = { 617aa406e8bSJan Charvat .name = "qemu_ctucan_tx_buffer", 618aa406e8bSJan Charvat .version_id = 1, 619aa406e8bSJan Charvat .minimum_version_id = 1, 620*1de81b42SRichard Henderson .fields = (const VMStateField[]) { 621aa406e8bSJan Charvat VMSTATE_UINT8_ARRAY(data, CtuCanCoreMsgBuffer, CTUCAN_CORE_MSG_MAX_LEN), 622aa406e8bSJan Charvat VMSTATE_END_OF_LIST() 623aa406e8bSJan Charvat } 624aa406e8bSJan Charvat }; 625aa406e8bSJan Charvat 626aa406e8bSJan Charvat static int ctucan_post_load(void *opaque, int version_id) 627aa406e8bSJan Charvat { 628aa406e8bSJan Charvat CtuCanCoreState *s = opaque; 629aa406e8bSJan Charvat ctucan_update_irq(s); 630aa406e8bSJan Charvat return 0; 631aa406e8bSJan Charvat } 632aa406e8bSJan Charvat 633aa406e8bSJan Charvat /* VMState is needed for live migration of QEMU images */ 634aa406e8bSJan Charvat const VMStateDescription vmstate_ctucan = { 635aa406e8bSJan Charvat .name = "ctucan", 636aa406e8bSJan Charvat .version_id = 1, 637aa406e8bSJan Charvat .minimum_version_id = 1, 638aa406e8bSJan Charvat .post_load = ctucan_post_load, 639*1de81b42SRichard Henderson .fields = (const VMStateField[]) { 640aa406e8bSJan Charvat VMSTATE_UINT32(mode_settings.u32, CtuCanCoreState), 641aa406e8bSJan Charvat VMSTATE_UINT32(status.u32, CtuCanCoreState), 642aa406e8bSJan Charvat VMSTATE_UINT32(int_stat.u32, CtuCanCoreState), 643aa406e8bSJan Charvat VMSTATE_UINT32(int_ena.u32, CtuCanCoreState), 644aa406e8bSJan Charvat VMSTATE_UINT32(int_mask.u32, CtuCanCoreState), 645aa406e8bSJan Charvat VMSTATE_UINT32(brt.u32, CtuCanCoreState), 646aa406e8bSJan Charvat VMSTATE_UINT32(brt_fd.u32, CtuCanCoreState), 647aa406e8bSJan Charvat VMSTATE_UINT32(ewl_erp_fault_state.u32, CtuCanCoreState), 648aa406e8bSJan Charvat VMSTATE_UINT32(rec_tec.u32, CtuCanCoreState), 649aa406e8bSJan Charvat VMSTATE_UINT32(err_norm_err_fd.u32, CtuCanCoreState), 650aa406e8bSJan Charvat VMSTATE_UINT32(ctr_pres.u32, CtuCanCoreState), 651aa406e8bSJan Charvat VMSTATE_UINT32(filter_a_mask.u32, CtuCanCoreState), 652aa406e8bSJan Charvat VMSTATE_UINT32(filter_a_val.u32, CtuCanCoreState), 653aa406e8bSJan Charvat VMSTATE_UINT32(filter_b_mask.u32, CtuCanCoreState), 654aa406e8bSJan Charvat VMSTATE_UINT32(filter_b_val.u32, CtuCanCoreState), 655aa406e8bSJan Charvat VMSTATE_UINT32(filter_c_mask.u32, CtuCanCoreState), 656aa406e8bSJan Charvat VMSTATE_UINT32(filter_c_val.u32, CtuCanCoreState), 657aa406e8bSJan Charvat VMSTATE_UINT32(filter_ran_low.u32, CtuCanCoreState), 658aa406e8bSJan Charvat VMSTATE_UINT32(filter_ran_high.u32, CtuCanCoreState), 659aa406e8bSJan Charvat VMSTATE_UINT32(filter_control_filter_status.u32, CtuCanCoreState), 660aa406e8bSJan Charvat VMSTATE_UINT32(rx_mem_info.u32, CtuCanCoreState), 661aa406e8bSJan Charvat VMSTATE_UINT32(rx_pointers.u32, CtuCanCoreState), 662aa406e8bSJan Charvat VMSTATE_UINT32(rx_status_rx_settings.u32, CtuCanCoreState), 663aa406e8bSJan Charvat VMSTATE_UINT32(tx_status.u32, CtuCanCoreState), 664aa406e8bSJan Charvat VMSTATE_UINT32(tx_priority.u32, CtuCanCoreState), 665aa406e8bSJan Charvat VMSTATE_UINT32(err_capt_alc.u32, CtuCanCoreState), 666aa406e8bSJan Charvat VMSTATE_UINT32(trv_delay_ssp_cfg.u32, CtuCanCoreState), 667aa406e8bSJan Charvat VMSTATE_UINT32(rx_fr_ctr.u32, CtuCanCoreState), 668aa406e8bSJan Charvat VMSTATE_UINT32(tx_fr_ctr.u32, CtuCanCoreState), 669aa406e8bSJan Charvat VMSTATE_UINT32(debug_register.u32, CtuCanCoreState), 670aa406e8bSJan Charvat VMSTATE_UINT32(yolo_reg.u32, CtuCanCoreState), 671aa406e8bSJan Charvat VMSTATE_UINT32(timestamp_low.u32, CtuCanCoreState), 672aa406e8bSJan Charvat VMSTATE_UINT32(timestamp_high.u32, CtuCanCoreState), 673aa406e8bSJan Charvat 674aa406e8bSJan Charvat VMSTATE_STRUCT_ARRAY(tx_buffer, CtuCanCoreState, 675aa406e8bSJan Charvat CTUCAN_CORE_TXBUF_NUM, 0, vmstate_qemu_ctucan_tx_buffer, 676aa406e8bSJan Charvat CtuCanCoreMsgBuffer), 677aa406e8bSJan Charvat 678aa406e8bSJan Charvat VMSTATE_BUFFER(rx_buff, CtuCanCoreState), 679aa406e8bSJan Charvat VMSTATE_UINT32(rx_tail_pos, CtuCanCoreState), 680aa406e8bSJan Charvat VMSTATE_UINT32(rx_cnt, CtuCanCoreState), 681aa406e8bSJan Charvat VMSTATE_UINT32(rx_frame_rem, CtuCanCoreState), 682aa406e8bSJan Charvat 683aa406e8bSJan Charvat VMSTATE_END_OF_LIST() 684aa406e8bSJan Charvat } 685aa406e8bSJan Charvat }; 686