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                                 &reg_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 = (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 = (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 = (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