1 /* 2 * QEMU model of the Configuration Frame Control module 3 * 4 * Copyright (C) 2023, Advanced Micro Devices, Inc. 5 * 6 * Written by Francisco Iglesias <francisco.iglesias@amd.com> 7 * 8 * SPDX-License-Identifier: GPL-2.0-or-later 9 */ 10 11 #include "qemu/osdep.h" 12 #include "hw/sysbus.h" 13 #include "hw/register.h" 14 #include "hw/registerfields.h" 15 #include "qemu/bitops.h" 16 #include "qemu/log.h" 17 #include "qemu/units.h" 18 #include "qapi/error.h" 19 #include "hw/qdev-properties.h" 20 #include "migration/vmstate.h" 21 #include "hw/irq.h" 22 #include "hw/misc/xlnx-versal-cframe-reg.h" 23 24 #ifndef XLNX_VERSAL_CFRAME_REG_ERR_DEBUG 25 #define XLNX_VERSAL_CFRAME_REG_ERR_DEBUG 0 26 #endif 27 28 #define KEYHOLE_STREAM_4K (4 * KiB) 29 #define N_WORDS_128BIT 4 30 31 #define MAX_BLOCKTYPE 6 32 #define MAX_BLOCKTYPE_FRAMES 0xFFFFF 33 34 enum { 35 CFRAME_CMD_WCFG = 1, 36 CFRAME_CMD_ROWON = 2, 37 CFRAME_CMD_ROWOFF = 3, 38 CFRAME_CMD_RCFG = 4, 39 CFRAME_CMD_DLPARK = 5, 40 }; 41 42 static gint int_cmp(gconstpointer a, gconstpointer b, gpointer user_data) 43 { 44 guint ua = GPOINTER_TO_UINT(a); 45 guint ub = GPOINTER_TO_UINT(b); 46 return (ua > ub) - (ua < ub); 47 } 48 49 static void cfrm_imr_update_irq(XlnxVersalCFrameReg *s) 50 { 51 bool pending = s->regs[R_CFRM_ISR0] & ~s->regs[R_CFRM_IMR0]; 52 qemu_set_irq(s->irq_cfrm_imr, pending); 53 } 54 55 static void cfrm_isr_postw(RegisterInfo *reg, uint64_t val64) 56 { 57 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(reg->opaque); 58 cfrm_imr_update_irq(s); 59 } 60 61 static uint64_t cfrm_ier_prew(RegisterInfo *reg, uint64_t val64) 62 { 63 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(reg->opaque); 64 65 s->regs[R_CFRM_IMR0] &= ~s->regs[R_CFRM_IER0]; 66 s->regs[R_CFRM_IER0] = 0; 67 cfrm_imr_update_irq(s); 68 return 0; 69 } 70 71 static uint64_t cfrm_idr_prew(RegisterInfo *reg, uint64_t val64) 72 { 73 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(reg->opaque); 74 75 s->regs[R_CFRM_IMR0] |= s->regs[R_CFRM_IDR0]; 76 s->regs[R_CFRM_IDR0] = 0; 77 cfrm_imr_update_irq(s); 78 return 0; 79 } 80 81 static uint64_t cfrm_itr_prew(RegisterInfo *reg, uint64_t val64) 82 { 83 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(reg->opaque); 84 85 s->regs[R_CFRM_ISR0] |= s->regs[R_CFRM_ITR0]; 86 s->regs[R_CFRM_ITR0] = 0; 87 cfrm_imr_update_irq(s); 88 return 0; 89 } 90 91 static void cframe_incr_far(XlnxVersalCFrameReg *s) 92 { 93 uint32_t faddr = ARRAY_FIELD_EX32(s->regs, FAR0, FRAME_ADDR); 94 uint32_t blktype = ARRAY_FIELD_EX32(s->regs, FAR0, BLOCKTYPE); 95 96 assert(blktype <= MAX_BLOCKTYPE); 97 98 faddr++; 99 if (faddr > s->cfg.blktype_num_frames[blktype]) { 100 /* Restart from 0 and increment block type */ 101 faddr = 0; 102 blktype++; 103 104 assert(blktype <= MAX_BLOCKTYPE); 105 106 ARRAY_FIELD_DP32(s->regs, FAR0, BLOCKTYPE, blktype); 107 } 108 109 ARRAY_FIELD_DP32(s->regs, FAR0, FRAME_ADDR, faddr); 110 } 111 112 static void cfrm_fdri_post_write(RegisterInfo *reg, uint64_t val) 113 { 114 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(reg->opaque); 115 116 if (s->row_configured && s->rowon && s->wcfg) { 117 118 if (fifo32_num_free(&s->new_f_data) >= N_WORDS_128BIT) { 119 fifo32_push(&s->new_f_data, s->regs[R_FDRI0]); 120 fifo32_push(&s->new_f_data, s->regs[R_FDRI1]); 121 fifo32_push(&s->new_f_data, s->regs[R_FDRI2]); 122 fifo32_push(&s->new_f_data, s->regs[R_FDRI3]); 123 } 124 125 if (fifo32_is_full(&s->new_f_data)) { 126 uint32_t addr = extract32(s->regs[R_FAR0], 0, 23); 127 XlnxCFrame *f = g_new(XlnxCFrame, 1); 128 129 for (int i = 0; i < FRAME_NUM_WORDS; i++) { 130 f->data[i] = fifo32_pop(&s->new_f_data); 131 } 132 133 g_tree_replace(s->cframes, GUINT_TO_POINTER(addr), f); 134 135 cframe_incr_far(s); 136 137 fifo32_reset(&s->new_f_data); 138 } 139 } 140 } 141 142 static void cfrm_readout_frames(XlnxVersalCFrameReg *s, uint32_t start_addr, 143 uint32_t end_addr) 144 { 145 /* 146 * NB: when our minimum glib version is at least 2.68 we can improve the 147 * performance of the cframe traversal by using g_tree_lookup_node and 148 * g_tree_node_next (instead of calling g_tree_lookup for finding each 149 * cframe). 150 */ 151 for (uint32_t addr = start_addr; addr < end_addr; addr++) { 152 XlnxCFrame *f = g_tree_lookup(s->cframes, GUINT_TO_POINTER(addr)); 153 154 /* Transmit the data if a frame was found */ 155 if (f) { 156 for (int i = 0; i < FRAME_NUM_WORDS; i += 4) { 157 XlnxCfiPacket pkt = {}; 158 159 pkt.data[0] = f->data[i]; 160 pkt.data[1] = f->data[i + 1]; 161 pkt.data[2] = f->data[i + 2]; 162 pkt.data[3] = f->data[i + 3]; 163 164 if (s->cfg.cfu_fdro) { 165 xlnx_cfi_transfer_packet(s->cfg.cfu_fdro, &pkt); 166 } 167 } 168 } 169 } 170 } 171 172 static void cfrm_frcnt_post_write(RegisterInfo *reg, uint64_t val) 173 { 174 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(reg->opaque); 175 176 if (s->row_configured && s->rowon && s->rcfg) { 177 uint32_t start_addr = extract32(s->regs[R_FAR0], 0, 23); 178 uint32_t end_addr = start_addr + s->regs[R_FRCNT0] / FRAME_NUM_QWORDS; 179 180 cfrm_readout_frames(s, start_addr, end_addr); 181 } 182 } 183 184 static void cfrm_cmd_post_write(RegisterInfo *reg, uint64_t val) 185 { 186 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(reg->opaque); 187 188 if (s->row_configured) { 189 uint8_t cmd = ARRAY_FIELD_EX32(s->regs, CMD0, CMD); 190 191 switch (cmd) { 192 case CFRAME_CMD_WCFG: 193 s->wcfg = true; 194 break; 195 case CFRAME_CMD_ROWON: 196 s->rowon = true; 197 break; 198 case CFRAME_CMD_ROWOFF: 199 s->rowon = false; 200 break; 201 case CFRAME_CMD_RCFG: 202 s->rcfg = true; 203 break; 204 case CFRAME_CMD_DLPARK: 205 s->wcfg = false; 206 s->rcfg = false; 207 break; 208 default: 209 break; 210 }; 211 } 212 } 213 214 static uint64_t cfrm_last_frame_bot_post_read(RegisterInfo *reg, 215 uint64_t val64) 216 { 217 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(reg->opaque); 218 uint64_t val = 0; 219 220 switch (reg->access->addr) { 221 case A_LAST_FRAME_BOT0: 222 val = FIELD_DP32(val, LAST_FRAME_BOT0, BLOCKTYPE1_LAST_FRAME_LSB, 223 s->cfg.blktype_num_frames[1]); 224 val = FIELD_DP32(val, LAST_FRAME_BOT0, BLOCKTYPE0_LAST_FRAME, 225 s->cfg.blktype_num_frames[0]); 226 break; 227 case A_LAST_FRAME_BOT1: 228 val = FIELD_DP32(val, LAST_FRAME_BOT1, BLOCKTYPE3_LAST_FRAME_LSB, 229 s->cfg.blktype_num_frames[3]); 230 val = FIELD_DP32(val, LAST_FRAME_BOT1, BLOCKTYPE2_LAST_FRAME, 231 s->cfg.blktype_num_frames[2]); 232 val = FIELD_DP32(val, LAST_FRAME_BOT1, BLOCKTYPE1_LAST_FRAME_MSB, 233 (s->cfg.blktype_num_frames[1] >> 12)); 234 break; 235 case A_LAST_FRAME_BOT2: 236 val = FIELD_DP32(val, LAST_FRAME_BOT2, BLOCKTYPE3_LAST_FRAME_MSB, 237 (s->cfg.blktype_num_frames[3] >> 4)); 238 break; 239 case A_LAST_FRAME_BOT3: 240 default: 241 break; 242 } 243 244 return val; 245 } 246 247 static uint64_t cfrm_last_frame_top_post_read(RegisterInfo *reg, 248 uint64_t val64) 249 { 250 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(reg->opaque); 251 uint64_t val = 0; 252 253 switch (reg->access->addr) { 254 case A_LAST_FRAME_TOP0: 255 val = FIELD_DP32(val, LAST_FRAME_TOP0, BLOCKTYPE5_LAST_FRAME_LSB, 256 s->cfg.blktype_num_frames[5]); 257 val = FIELD_DP32(val, LAST_FRAME_TOP0, BLOCKTYPE4_LAST_FRAME, 258 s->cfg.blktype_num_frames[4]); 259 break; 260 case A_LAST_FRAME_TOP1: 261 val = FIELD_DP32(val, LAST_FRAME_TOP1, BLOCKTYPE6_LAST_FRAME, 262 s->cfg.blktype_num_frames[6]); 263 val = FIELD_DP32(val, LAST_FRAME_TOP1, BLOCKTYPE5_LAST_FRAME_MSB, 264 (s->cfg.blktype_num_frames[5] >> 12)); 265 break; 266 case A_LAST_FRAME_TOP2: 267 case A_LAST_FRAME_BOT3: 268 default: 269 break; 270 } 271 272 return val; 273 } 274 275 static void cfrm_far_sfr_post_write(RegisterInfo *reg, uint64_t val) 276 { 277 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(reg->opaque); 278 279 if (s->row_configured && s->rowon && s->rcfg) { 280 uint32_t start_addr = extract32(s->regs[R_FAR_SFR0], 0, 23); 281 282 /* Readback 1 frame */ 283 cfrm_readout_frames(s, start_addr, start_addr + 1); 284 } 285 } 286 287 static const RegisterAccessInfo cframe_reg_regs_info[] = { 288 { .name = "CRC0", .addr = A_CRC0, 289 .rsvd = 0x00000000, 290 },{ .name = "CRC1", .addr = A_CRC0, 291 .rsvd = 0xffffffff, 292 },{ .name = "CRC2", .addr = A_CRC0, 293 .rsvd = 0xffffffff, 294 },{ .name = "CRC3", .addr = A_CRC0, 295 .rsvd = 0xffffffff, 296 },{ .name = "FAR0", .addr = A_FAR0, 297 .rsvd = 0xfe000000, 298 },{ .name = "FAR1", .addr = A_FAR1, 299 .rsvd = 0xffffffff, 300 },{ .name = "FAR2", .addr = A_FAR2, 301 .rsvd = 0xffffffff, 302 },{ .name = "FAR3", .addr = A_FAR3, 303 .rsvd = 0xffffffff, 304 },{ .name = "FAR_SFR0", .addr = A_FAR_SFR0, 305 .rsvd = 0xff800000, 306 },{ .name = "FAR_SFR1", .addr = A_FAR_SFR1, 307 .rsvd = 0xffffffff, 308 },{ .name = "FAR_SFR2", .addr = A_FAR_SFR2, 309 .rsvd = 0xffffffff, 310 },{ .name = "FAR_SFR3", .addr = A_FAR_SFR3, 311 .rsvd = 0xffffffff, 312 .post_write = cfrm_far_sfr_post_write, 313 },{ .name = "FDRI0", .addr = A_FDRI0, 314 },{ .name = "FDRI1", .addr = A_FDRI1, 315 },{ .name = "FDRI2", .addr = A_FDRI2, 316 },{ .name = "FDRI3", .addr = A_FDRI3, 317 .post_write = cfrm_fdri_post_write, 318 },{ .name = "FRCNT0", .addr = A_FRCNT0, 319 .rsvd = 0x00000000, 320 },{ .name = "FRCNT1", .addr = A_FRCNT1, 321 .rsvd = 0xffffffff, 322 },{ .name = "FRCNT2", .addr = A_FRCNT2, 323 .rsvd = 0xffffffff, 324 },{ .name = "FRCNT3", .addr = A_FRCNT3, 325 .rsvd = 0xffffffff, 326 .post_write = cfrm_frcnt_post_write 327 },{ .name = "CMD0", .addr = A_CMD0, 328 .rsvd = 0xffffffe0, 329 },{ .name = "CMD1", .addr = A_CMD1, 330 .rsvd = 0xffffffff, 331 },{ .name = "CMD2", .addr = A_CMD2, 332 .rsvd = 0xffffffff, 333 },{ .name = "CMD3", .addr = A_CMD3, 334 .rsvd = 0xffffffff, 335 .post_write = cfrm_cmd_post_write 336 },{ .name = "CR_MASK0", .addr = A_CR_MASK0, 337 .rsvd = 0x00000000, 338 },{ .name = "CR_MASK1", .addr = A_CR_MASK1, 339 .rsvd = 0x00000000, 340 },{ .name = "CR_MASK2", .addr = A_CR_MASK2, 341 .rsvd = 0x00000000, 342 },{ .name = "CR_MASK3", .addr = A_CR_MASK3, 343 .rsvd = 0xffffffff, 344 },{ .name = "CTL0", .addr = A_CTL0, 345 .rsvd = 0xfffffff8, 346 },{ .name = "CTL1", .addr = A_CTL1, 347 .rsvd = 0xffffffff, 348 },{ .name = "CTL2", .addr = A_CTL2, 349 .rsvd = 0xffffffff, 350 },{ .name = "CTL3", .addr = A_CTL3, 351 .rsvd = 0xffffffff, 352 },{ .name = "CFRM_ISR0", .addr = A_CFRM_ISR0, 353 .rsvd = 0xffc04000, 354 .w1c = 0x3bfff, 355 },{ .name = "CFRM_ISR1", .addr = A_CFRM_ISR1, 356 .rsvd = 0xffffffff, 357 },{ .name = "CFRM_ISR2", .addr = A_CFRM_ISR2, 358 .rsvd = 0xffffffff, 359 },{ .name = "CFRM_ISR3", .addr = A_CFRM_ISR3, 360 .rsvd = 0xffffffff, 361 .post_write = cfrm_isr_postw, 362 },{ .name = "CFRM_IMR0", .addr = A_CFRM_IMR0, 363 .rsvd = 0xffc04000, 364 .ro = 0xfffff, 365 .reset = 0x3bfff, 366 },{ .name = "CFRM_IMR1", .addr = A_CFRM_IMR1, 367 .rsvd = 0xffffffff, 368 },{ .name = "CFRM_IMR2", .addr = A_CFRM_IMR2, 369 .rsvd = 0xffffffff, 370 },{ .name = "CFRM_IMR3", .addr = A_CFRM_IMR3, 371 .rsvd = 0xffffffff, 372 },{ .name = "CFRM_IER0", .addr = A_CFRM_IER0, 373 .rsvd = 0xffc04000, 374 },{ .name = "CFRM_IER1", .addr = A_CFRM_IER1, 375 .rsvd = 0xffffffff, 376 },{ .name = "CFRM_IER2", .addr = A_CFRM_IER2, 377 .rsvd = 0xffffffff, 378 },{ .name = "CFRM_IER3", .addr = A_CFRM_IER3, 379 .rsvd = 0xffffffff, 380 .pre_write = cfrm_ier_prew, 381 },{ .name = "CFRM_IDR0", .addr = A_CFRM_IDR0, 382 .rsvd = 0xffc04000, 383 },{ .name = "CFRM_IDR1", .addr = A_CFRM_IDR1, 384 .rsvd = 0xffffffff, 385 },{ .name = "CFRM_IDR2", .addr = A_CFRM_IDR2, 386 .rsvd = 0xffffffff, 387 },{ .name = "CFRM_IDR3", .addr = A_CFRM_IDR3, 388 .rsvd = 0xffffffff, 389 .pre_write = cfrm_idr_prew, 390 },{ .name = "CFRM_ITR0", .addr = A_CFRM_ITR0, 391 .rsvd = 0xffc04000, 392 },{ .name = "CFRM_ITR1", .addr = A_CFRM_ITR1, 393 .rsvd = 0xffffffff, 394 },{ .name = "CFRM_ITR2", .addr = A_CFRM_ITR2, 395 .rsvd = 0xffffffff, 396 },{ .name = "CFRM_ITR3", .addr = A_CFRM_ITR3, 397 .rsvd = 0xffffffff, 398 .pre_write = cfrm_itr_prew, 399 },{ .name = "SEU_SYNDRM00", .addr = A_SEU_SYNDRM00, 400 },{ .name = "SEU_SYNDRM01", .addr = A_SEU_SYNDRM01, 401 },{ .name = "SEU_SYNDRM02", .addr = A_SEU_SYNDRM02, 402 },{ .name = "SEU_SYNDRM03", .addr = A_SEU_SYNDRM03, 403 },{ .name = "SEU_SYNDRM10", .addr = A_SEU_SYNDRM10, 404 },{ .name = "SEU_SYNDRM11", .addr = A_SEU_SYNDRM11, 405 },{ .name = "SEU_SYNDRM12", .addr = A_SEU_SYNDRM12, 406 },{ .name = "SEU_SYNDRM13", .addr = A_SEU_SYNDRM13, 407 },{ .name = "SEU_SYNDRM20", .addr = A_SEU_SYNDRM20, 408 },{ .name = "SEU_SYNDRM21", .addr = A_SEU_SYNDRM21, 409 },{ .name = "SEU_SYNDRM22", .addr = A_SEU_SYNDRM22, 410 },{ .name = "SEU_SYNDRM23", .addr = A_SEU_SYNDRM23, 411 },{ .name = "SEU_SYNDRM30", .addr = A_SEU_SYNDRM30, 412 },{ .name = "SEU_SYNDRM31", .addr = A_SEU_SYNDRM31, 413 },{ .name = "SEU_SYNDRM32", .addr = A_SEU_SYNDRM32, 414 },{ .name = "SEU_SYNDRM33", .addr = A_SEU_SYNDRM33, 415 },{ .name = "SEU_VIRTUAL_SYNDRM0", .addr = A_SEU_VIRTUAL_SYNDRM0, 416 },{ .name = "SEU_VIRTUAL_SYNDRM1", .addr = A_SEU_VIRTUAL_SYNDRM1, 417 },{ .name = "SEU_VIRTUAL_SYNDRM2", .addr = A_SEU_VIRTUAL_SYNDRM2, 418 },{ .name = "SEU_VIRTUAL_SYNDRM3", .addr = A_SEU_VIRTUAL_SYNDRM3, 419 },{ .name = "SEU_CRC0", .addr = A_SEU_CRC0, 420 },{ .name = "SEU_CRC1", .addr = A_SEU_CRC1, 421 },{ .name = "SEU_CRC2", .addr = A_SEU_CRC2, 422 },{ .name = "SEU_CRC3", .addr = A_SEU_CRC3, 423 },{ .name = "CFRAME_FAR_BOT0", .addr = A_CFRAME_FAR_BOT0, 424 },{ .name = "CFRAME_FAR_BOT1", .addr = A_CFRAME_FAR_BOT1, 425 },{ .name = "CFRAME_FAR_BOT2", .addr = A_CFRAME_FAR_BOT2, 426 },{ .name = "CFRAME_FAR_BOT3", .addr = A_CFRAME_FAR_BOT3, 427 },{ .name = "CFRAME_FAR_TOP0", .addr = A_CFRAME_FAR_TOP0, 428 },{ .name = "CFRAME_FAR_TOP1", .addr = A_CFRAME_FAR_TOP1, 429 },{ .name = "CFRAME_FAR_TOP2", .addr = A_CFRAME_FAR_TOP2, 430 },{ .name = "CFRAME_FAR_TOP3", .addr = A_CFRAME_FAR_TOP3, 431 },{ .name = "LAST_FRAME_BOT0", .addr = A_LAST_FRAME_BOT0, 432 .ro = 0xffffffff, 433 .post_read = cfrm_last_frame_bot_post_read, 434 },{ .name = "LAST_FRAME_BOT1", .addr = A_LAST_FRAME_BOT1, 435 .ro = 0xffffffff, 436 .post_read = cfrm_last_frame_bot_post_read, 437 },{ .name = "LAST_FRAME_BOT2", .addr = A_LAST_FRAME_BOT2, 438 .ro = 0xffffffff, 439 .post_read = cfrm_last_frame_bot_post_read, 440 },{ .name = "LAST_FRAME_BOT3", .addr = A_LAST_FRAME_BOT3, 441 .ro = 0xffffffff, 442 .post_read = cfrm_last_frame_bot_post_read, 443 },{ .name = "LAST_FRAME_TOP0", .addr = A_LAST_FRAME_TOP0, 444 .ro = 0xffffffff, 445 .post_read = cfrm_last_frame_top_post_read, 446 },{ .name = "LAST_FRAME_TOP1", .addr = A_LAST_FRAME_TOP1, 447 .ro = 0xffffffff, 448 .post_read = cfrm_last_frame_top_post_read, 449 },{ .name = "LAST_FRAME_TOP2", .addr = A_LAST_FRAME_TOP2, 450 .ro = 0xffffffff, 451 .post_read = cfrm_last_frame_top_post_read, 452 },{ .name = "LAST_FRAME_TOP3", .addr = A_LAST_FRAME_TOP3, 453 .ro = 0xffffffff, 454 .post_read = cfrm_last_frame_top_post_read, 455 } 456 }; 457 458 static void cframe_reg_cfi_transfer_packet(XlnxCfiIf *cfi_if, 459 XlnxCfiPacket *pkt) 460 { 461 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(cfi_if); 462 uint64_t we = MAKE_64BIT_MASK(0, 4 * 8); 463 464 if (!s->row_configured) { 465 return; 466 } 467 468 switch (pkt->reg_addr) { 469 case CFRAME_FAR: 470 s->regs[R_FAR0] = pkt->data[0]; 471 break; 472 case CFRAME_SFR: 473 s->regs[R_FAR_SFR0] = pkt->data[0]; 474 register_write(&s->regs_info[R_FAR_SFR3], 0, 475 we, object_get_typename(OBJECT(s)), 476 XLNX_VERSAL_CFRAME_REG_ERR_DEBUG); 477 break; 478 case CFRAME_FDRI: 479 s->regs[R_FDRI0] = pkt->data[0]; 480 s->regs[R_FDRI1] = pkt->data[1]; 481 s->regs[R_FDRI2] = pkt->data[2]; 482 register_write(&s->regs_info[R_FDRI3], pkt->data[3], 483 we, object_get_typename(OBJECT(s)), 484 XLNX_VERSAL_CFRAME_REG_ERR_DEBUG); 485 break; 486 case CFRAME_CMD: 487 ARRAY_FIELD_DP32(s->regs, CMD0, CMD, pkt->data[0]); 488 489 register_write(&s->regs_info[R_CMD3], 0, 490 we, object_get_typename(OBJECT(s)), 491 XLNX_VERSAL_CFRAME_REG_ERR_DEBUG); 492 break; 493 default: 494 break; 495 } 496 } 497 498 static uint64_t cframe_reg_fdri_read(void *opaque, hwaddr addr, unsigned size) 499 { 500 qemu_log_mask(LOG_GUEST_ERROR, "%s: Unsupported read from addr=%" 501 HWADDR_PRIx "\n", __func__, addr); 502 return 0; 503 } 504 505 static void cframe_reg_fdri_write(void *opaque, hwaddr addr, uint64_t value, 506 unsigned size) 507 { 508 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(opaque); 509 uint32_t wfifo[WFIFO_SZ]; 510 511 if (update_wfifo(addr, value, s->wfifo, wfifo)) { 512 uint64_t we = MAKE_64BIT_MASK(0, 4 * 8); 513 514 s->regs[R_FDRI0] = wfifo[0]; 515 s->regs[R_FDRI1] = wfifo[1]; 516 s->regs[R_FDRI2] = wfifo[2]; 517 register_write(&s->regs_info[R_FDRI3], wfifo[3], 518 we, object_get_typename(OBJECT(s)), 519 XLNX_VERSAL_CFRAME_REG_ERR_DEBUG); 520 } 521 } 522 523 static void cframe_reg_reset_enter(Object *obj, ResetType type) 524 { 525 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(obj); 526 unsigned int i; 527 528 for (i = 0; i < ARRAY_SIZE(s->regs_info); ++i) { 529 register_reset(&s->regs_info[i]); 530 } 531 memset(s->wfifo, 0, WFIFO_SZ * sizeof(uint32_t)); 532 fifo32_reset(&s->new_f_data); 533 534 if (g_tree_nnodes(s->cframes)) { 535 /* 536 * Take a reference so when g_tree_destroy() unrefs it we keep the 537 * GTree and only destroy its contents. NB: when our minimum 538 * glib version is at least 2.70 we could use g_tree_remove_all(). 539 */ 540 g_tree_ref(s->cframes); 541 g_tree_destroy(s->cframes); 542 } 543 } 544 545 static void cframe_reg_reset_hold(Object *obj) 546 { 547 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(obj); 548 549 cfrm_imr_update_irq(s); 550 } 551 552 static const MemoryRegionOps cframe_reg_ops = { 553 .read = register_read_memory, 554 .write = register_write_memory, 555 .endianness = DEVICE_LITTLE_ENDIAN, 556 .valid = { 557 .min_access_size = 4, 558 .max_access_size = 4, 559 }, 560 }; 561 562 static const MemoryRegionOps cframe_reg_fdri_ops = { 563 .read = cframe_reg_fdri_read, 564 .write = cframe_reg_fdri_write, 565 .endianness = DEVICE_LITTLE_ENDIAN, 566 .valid = { 567 .min_access_size = 4, 568 .max_access_size = 4, 569 }, 570 }; 571 572 static uint64_t cframes_bcast_reg_read(void *opaque, hwaddr addr, unsigned size) 573 { 574 qemu_log_mask(LOG_GUEST_ERROR, "%s: Unsupported read from addr=%" 575 HWADDR_PRIx "\n", __func__, addr); 576 return 0; 577 } 578 579 static void cframes_bcast_write(XlnxVersalCFrameBcastReg *s, uint8_t reg_addr, 580 uint32_t *wfifo) 581 { 582 XlnxCfiPacket pkt = { 583 .reg_addr = reg_addr, 584 .data[0] = wfifo[0], 585 .data[1] = wfifo[1], 586 .data[2] = wfifo[2], 587 .data[3] = wfifo[3] 588 }; 589 590 for (int i = 0; i < ARRAY_SIZE(s->cfg.cframe); i++) { 591 if (s->cfg.cframe[i]) { 592 xlnx_cfi_transfer_packet(s->cfg.cframe[i], &pkt); 593 } 594 } 595 } 596 597 static void cframes_bcast_reg_write(void *opaque, hwaddr addr, uint64_t value, 598 unsigned size) 599 { 600 XlnxVersalCFrameBcastReg *s = XLNX_VERSAL_CFRAME_BCAST_REG(opaque); 601 uint32_t wfifo[WFIFO_SZ]; 602 603 if (update_wfifo(addr, value, s->wfifo, wfifo)) { 604 uint8_t reg_addr = extract32(addr, 4, 6); 605 606 cframes_bcast_write(s, reg_addr, wfifo); 607 } 608 } 609 610 static uint64_t cframes_bcast_fdri_read(void *opaque, hwaddr addr, 611 unsigned size) 612 { 613 qemu_log_mask(LOG_GUEST_ERROR, "%s: Unsupported read from addr=%" 614 HWADDR_PRIx "\n", __func__, addr); 615 return 0; 616 } 617 618 static void cframes_bcast_fdri_write(void *opaque, hwaddr addr, uint64_t value, 619 unsigned size) 620 { 621 XlnxVersalCFrameBcastReg *s = XLNX_VERSAL_CFRAME_BCAST_REG(opaque); 622 uint32_t wfifo[WFIFO_SZ]; 623 624 if (update_wfifo(addr, value, s->wfifo, wfifo)) { 625 cframes_bcast_write(s, CFRAME_FDRI, wfifo); 626 } 627 } 628 629 static const MemoryRegionOps cframes_bcast_reg_reg_ops = { 630 .read = cframes_bcast_reg_read, 631 .write = cframes_bcast_reg_write, 632 .endianness = DEVICE_LITTLE_ENDIAN, 633 .valid = { 634 .min_access_size = 4, 635 .max_access_size = 4, 636 }, 637 }; 638 639 static const MemoryRegionOps cframes_bcast_reg_fdri_ops = { 640 .read = cframes_bcast_fdri_read, 641 .write = cframes_bcast_fdri_write, 642 .endianness = DEVICE_LITTLE_ENDIAN, 643 .valid = { 644 .min_access_size = 4, 645 .max_access_size = 4, 646 }, 647 }; 648 649 static void cframe_reg_realize(DeviceState *dev, Error **errp) 650 { 651 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(dev); 652 653 for (int i = 0; i < ARRAY_SIZE(s->cfg.blktype_num_frames); i++) { 654 if (s->cfg.blktype_num_frames[i] > MAX_BLOCKTYPE_FRAMES) { 655 error_setg(errp, 656 "blktype-frames%d > 0xFFFFF (max frame per block)", 657 i); 658 return; 659 } 660 if (s->cfg.blktype_num_frames[i]) { 661 s->row_configured = true; 662 } 663 } 664 } 665 666 static void cframe_reg_init(Object *obj) 667 { 668 XlnxVersalCFrameReg *s = XLNX_VERSAL_CFRAME_REG(obj); 669 SysBusDevice *sbd = SYS_BUS_DEVICE(obj); 670 RegisterInfoArray *reg_array; 671 672 memory_region_init(&s->iomem, obj, TYPE_XLNX_VERSAL_CFRAME_REG, 673 CFRAME_REG_R_MAX * 4); 674 reg_array = 675 register_init_block32(DEVICE(obj), cframe_reg_regs_info, 676 ARRAY_SIZE(cframe_reg_regs_info), 677 s->regs_info, s->regs, 678 &cframe_reg_ops, 679 XLNX_VERSAL_CFRAME_REG_ERR_DEBUG, 680 CFRAME_REG_R_MAX * 4); 681 memory_region_add_subregion(&s->iomem, 682 0x0, 683 ®_array->mem); 684 sysbus_init_mmio(sbd, &s->iomem); 685 memory_region_init_io(&s->iomem_fdri, obj, &cframe_reg_fdri_ops, s, 686 TYPE_XLNX_VERSAL_CFRAME_REG "-fdri", 687 KEYHOLE_STREAM_4K); 688 sysbus_init_mmio(sbd, &s->iomem_fdri); 689 sysbus_init_irq(sbd, &s->irq_cfrm_imr); 690 691 s->cframes = g_tree_new_full((GCompareDataFunc)int_cmp, NULL, 692 NULL, (GDestroyNotify)g_free); 693 fifo32_create(&s->new_f_data, FRAME_NUM_WORDS); 694 } 695 696 static const VMStateDescription vmstate_cframe = { 697 .name = "cframe", 698 .version_id = 1, 699 .minimum_version_id = 1, 700 .fields = (const VMStateField[]) { 701 VMSTATE_UINT32_ARRAY(data, XlnxCFrame, FRAME_NUM_WORDS), 702 VMSTATE_END_OF_LIST() 703 } 704 }; 705 706 static const VMStateDescription vmstate_cframe_reg = { 707 .name = TYPE_XLNX_VERSAL_CFRAME_REG, 708 .version_id = 1, 709 .minimum_version_id = 1, 710 .fields = (const VMStateField[]) { 711 VMSTATE_UINT32_ARRAY(wfifo, XlnxVersalCFrameReg, 4), 712 VMSTATE_UINT32_ARRAY(regs, XlnxVersalCFrameReg, CFRAME_REG_R_MAX), 713 VMSTATE_BOOL(rowon, XlnxVersalCFrameReg), 714 VMSTATE_BOOL(wcfg, XlnxVersalCFrameReg), 715 VMSTATE_BOOL(rcfg, XlnxVersalCFrameReg), 716 VMSTATE_GTREE_DIRECT_KEY_V(cframes, XlnxVersalCFrameReg, 1, 717 &vmstate_cframe, XlnxCFrame), 718 VMSTATE_FIFO32(new_f_data, XlnxVersalCFrameReg), 719 VMSTATE_END_OF_LIST(), 720 } 721 }; 722 723 static Property cframe_regs_props[] = { 724 DEFINE_PROP_LINK("cfu-fdro", XlnxVersalCFrameReg, cfg.cfu_fdro, 725 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 726 DEFINE_PROP_UINT32("blktype0-frames", XlnxVersalCFrameReg, 727 cfg.blktype_num_frames[0], 0), 728 DEFINE_PROP_UINT32("blktype1-frames", XlnxVersalCFrameReg, 729 cfg.blktype_num_frames[1], 0), 730 DEFINE_PROP_UINT32("blktype2-frames", XlnxVersalCFrameReg, 731 cfg.blktype_num_frames[2], 0), 732 DEFINE_PROP_UINT32("blktype3-frames", XlnxVersalCFrameReg, 733 cfg.blktype_num_frames[3], 0), 734 DEFINE_PROP_UINT32("blktype4-frames", XlnxVersalCFrameReg, 735 cfg.blktype_num_frames[4], 0), 736 DEFINE_PROP_UINT32("blktype5-frames", XlnxVersalCFrameReg, 737 cfg.blktype_num_frames[5], 0), 738 DEFINE_PROP_UINT32("blktype6-frames", XlnxVersalCFrameReg, 739 cfg.blktype_num_frames[6], 0), 740 DEFINE_PROP_END_OF_LIST(), 741 }; 742 743 static void cframe_bcast_reg_init(Object *obj) 744 { 745 XlnxVersalCFrameBcastReg *s = XLNX_VERSAL_CFRAME_BCAST_REG(obj); 746 SysBusDevice *sbd = SYS_BUS_DEVICE(obj); 747 748 memory_region_init_io(&s->iomem_reg, obj, &cframes_bcast_reg_reg_ops, s, 749 TYPE_XLNX_VERSAL_CFRAME_BCAST_REG, KEYHOLE_STREAM_4K); 750 memory_region_init_io(&s->iomem_fdri, obj, &cframes_bcast_reg_fdri_ops, s, 751 TYPE_XLNX_VERSAL_CFRAME_BCAST_REG "-fdri", 752 KEYHOLE_STREAM_4K); 753 sysbus_init_mmio(sbd, &s->iomem_reg); 754 sysbus_init_mmio(sbd, &s->iomem_fdri); 755 } 756 757 static void cframe_bcast_reg_reset_enter(Object *obj, ResetType type) 758 { 759 XlnxVersalCFrameBcastReg *s = XLNX_VERSAL_CFRAME_BCAST_REG(obj); 760 761 memset(s->wfifo, 0, WFIFO_SZ * sizeof(uint32_t)); 762 } 763 764 static const VMStateDescription vmstate_cframe_bcast_reg = { 765 .name = TYPE_XLNX_VERSAL_CFRAME_BCAST_REG, 766 .version_id = 1, 767 .minimum_version_id = 1, 768 .fields = (const VMStateField[]) { 769 VMSTATE_UINT32_ARRAY(wfifo, XlnxVersalCFrameBcastReg, 4), 770 VMSTATE_END_OF_LIST(), 771 } 772 }; 773 774 static Property cframe_bcast_regs_props[] = { 775 DEFINE_PROP_LINK("cframe0", XlnxVersalCFrameBcastReg, cfg.cframe[0], 776 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 777 DEFINE_PROP_LINK("cframe1", XlnxVersalCFrameBcastReg, cfg.cframe[1], 778 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 779 DEFINE_PROP_LINK("cframe2", XlnxVersalCFrameBcastReg, cfg.cframe[2], 780 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 781 DEFINE_PROP_LINK("cframe3", XlnxVersalCFrameBcastReg, cfg.cframe[3], 782 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 783 DEFINE_PROP_LINK("cframe4", XlnxVersalCFrameBcastReg, cfg.cframe[4], 784 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 785 DEFINE_PROP_LINK("cframe5", XlnxVersalCFrameBcastReg, cfg.cframe[5], 786 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 787 DEFINE_PROP_LINK("cframe6", XlnxVersalCFrameBcastReg, cfg.cframe[6], 788 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 789 DEFINE_PROP_LINK("cframe7", XlnxVersalCFrameBcastReg, cfg.cframe[7], 790 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 791 DEFINE_PROP_LINK("cframe8", XlnxVersalCFrameBcastReg, cfg.cframe[8], 792 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 793 DEFINE_PROP_LINK("cframe9", XlnxVersalCFrameBcastReg, cfg.cframe[9], 794 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 795 DEFINE_PROP_LINK("cframe10", XlnxVersalCFrameBcastReg, cfg.cframe[10], 796 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 797 DEFINE_PROP_LINK("cframe11", XlnxVersalCFrameBcastReg, cfg.cframe[11], 798 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 799 DEFINE_PROP_LINK("cframe12", XlnxVersalCFrameBcastReg, cfg.cframe[12], 800 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 801 DEFINE_PROP_LINK("cframe13", XlnxVersalCFrameBcastReg, cfg.cframe[13], 802 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 803 DEFINE_PROP_LINK("cframe14", XlnxVersalCFrameBcastReg, cfg.cframe[14], 804 TYPE_XLNX_CFI_IF, XlnxCfiIf *), 805 DEFINE_PROP_END_OF_LIST(), 806 }; 807 808 static void cframe_reg_class_init(ObjectClass *klass, void *data) 809 { 810 ResettableClass *rc = RESETTABLE_CLASS(klass); 811 DeviceClass *dc = DEVICE_CLASS(klass); 812 XlnxCfiIfClass *xcic = XLNX_CFI_IF_CLASS(klass); 813 814 dc->vmsd = &vmstate_cframe_reg; 815 dc->realize = cframe_reg_realize; 816 rc->phases.enter = cframe_reg_reset_enter; 817 rc->phases.hold = cframe_reg_reset_hold; 818 device_class_set_props(dc, cframe_regs_props); 819 xcic->cfi_transfer_packet = cframe_reg_cfi_transfer_packet; 820 } 821 822 static void cframe_bcast_reg_class_init(ObjectClass *klass, void *data) 823 { 824 DeviceClass *dc = DEVICE_CLASS(klass); 825 ResettableClass *rc = RESETTABLE_CLASS(klass); 826 827 dc->vmsd = &vmstate_cframe_bcast_reg; 828 device_class_set_props(dc, cframe_bcast_regs_props); 829 rc->phases.enter = cframe_bcast_reg_reset_enter; 830 } 831 832 static const TypeInfo cframe_reg_info = { 833 .name = TYPE_XLNX_VERSAL_CFRAME_REG, 834 .parent = TYPE_SYS_BUS_DEVICE, 835 .instance_size = sizeof(XlnxVersalCFrameReg), 836 .class_init = cframe_reg_class_init, 837 .instance_init = cframe_reg_init, 838 .interfaces = (InterfaceInfo[]) { 839 { TYPE_XLNX_CFI_IF }, 840 { } 841 } 842 }; 843 844 static const TypeInfo cframe_bcast_reg_info = { 845 .name = TYPE_XLNX_VERSAL_CFRAME_BCAST_REG, 846 .parent = TYPE_SYS_BUS_DEVICE, 847 .instance_size = sizeof(XlnxVersalCFrameBcastReg), 848 .class_init = cframe_bcast_reg_class_init, 849 .instance_init = cframe_bcast_reg_init, 850 }; 851 852 static void cframe_reg_register_types(void) 853 { 854 type_register_static(&cframe_reg_info); 855 type_register_static(&cframe_bcast_reg_info); 856 } 857 858 type_init(cframe_reg_register_types) 859