2 * ADC registers for Xilinx Zynq Platform
4 * Copyright (c) 2015 Guenter Roeck
5 * Based on hw/misc/zynq_slcr.c, written by Michal Simek
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License
9 * as published by the Free Software Foundation; either version
10 * 2 of the License, or (at your option) any later version.
12 * You should have received a copy of the GNU General Public License along
13 * with this program; if not, see <http://www.gnu.org/licenses/>.
16 #include "qemu/osdep.h"
18 #include "hw/misc/zynq-xadc.h"
19 #include "migration/vmstate.h"
20 #include "qemu/timer.h"
21 #include "sysemu/sysemu.h"
23 #include "qemu/module.h"
35 #define CFG_ENABLE BIT(31)
36 #define CFG_CFIFOTH_SHIFT 20
37 #define CFG_CFIFOTH_LENGTH 4
38 #define CFG_DFIFOTH_SHIFT 16
39 #define CFG_DFIFOTH_LENGTH 4
40 #define CFG_WEDGE BIT(13)
41 #define CFG_REDGE BIT(12)
42 #define CFG_TCKRATE_SHIFT 8
43 #define CFG_TCKRATE_LENGTH 2
45 #define CFG_TCKRATE_DIV(x) (0x1 << (x - 1))
47 #define CFG_IGAP_SHIFT 0
48 #define CFG_IGAP_LENGTH 5
50 #define INT_CFIFO_LTH BIT(9)
51 #define INT_DFIFO_GTH BIT(8)
53 #define INT_ALM_SHIFT 0
54 #define INT_ALM_LENGTH 7
55 #define INT_ALM_MASK (((1 << INT_ALM_LENGTH) - 1) << INT_ALM_SHIFT)
57 #define INT_ALL (INT_CFIFO_LTH | INT_DFIFO_GTH | INT_OT | INT_ALM_MASK)
59 #define MSTS_CFIFO_LVL_SHIFT 16
60 #define MSTS_CFIFO_LVL_LENGTH 4
61 #define MSTS_DFIFO_LVL_SHIFT 12
62 #define MSTS_DFIFO_LVL_LENGTH 4
63 #define MSTS_CFIFOF BIT(11)
64 #define MSTS_CFIFOE BIT(10)
65 #define MSTS_DFIFOF BIT(9)
66 #define MSTS_DFIFOE BIT(8)
67 #define MSTS_OT BIT(7)
68 #define MSTS_ALM_SHIFT 0
69 #define MSTS_ALM_LENGTH 7
71 #define MCTL_RESET BIT(4)
75 #define CMD_WRITE 0x02
77 static void zynq_xadc_update_ints(ZynqXADCState
*s
)
80 /* We are fast, commands are actioned instantly so the CFIFO is always
81 * empty (and below threshold).
83 s
->regs
[INT_STS
] |= INT_CFIFO_LTH
;
85 if (s
->xadc_dfifo_entries
>
86 extract32(s
->regs
[CFG
], CFG_DFIFOTH_SHIFT
, CFG_DFIFOTH_LENGTH
)) {
87 s
->regs
[INT_STS
] |= INT_DFIFO_GTH
;
90 qemu_set_irq(s
->qemu_irq
, !!(s
->regs
[INT_STS
] & ~s
->regs
[INT_MASK
]));
93 static void zynq_xadc_reset(DeviceState
*d
)
95 ZynqXADCState
*s
= ZYNQ_XADC(d
);
97 s
->regs
[CFG
] = 0x14 << CFG_IGAP_SHIFT
|
98 CFG_TCKRATE_DIV(4) << CFG_TCKRATE_SHIFT
| CFG_REDGE
;
99 s
->regs
[INT_STS
] = INT_CFIFO_LTH
;
100 s
->regs
[INT_MASK
] = 0xffffffff;
101 s
->regs
[CMDFIFO
] = 0;
103 s
->regs
[MCTL
] = MCTL_RESET
;
105 memset(s
->xadc_regs
, 0, sizeof(s
->xadc_regs
));
106 memset(s
->xadc_dfifo
, 0, sizeof(s
->xadc_dfifo
));
107 s
->xadc_dfifo_entries
= 0;
109 zynq_xadc_update_ints(s
);
112 static uint16_t xadc_pop_dfifo(ZynqXADCState
*s
)
114 uint16_t rv
= s
->xadc_dfifo
[0];
117 if (s
->xadc_dfifo_entries
> 0) {
118 s
->xadc_dfifo_entries
--;
120 for (i
= 0; i
< s
->xadc_dfifo_entries
; i
++) {
121 s
->xadc_dfifo
[i
] = s
->xadc_dfifo
[i
+ 1];
123 s
->xadc_dfifo
[s
->xadc_dfifo_entries
] = 0;
124 zynq_xadc_update_ints(s
);
128 static void xadc_push_dfifo(ZynqXADCState
*s
, uint16_t regval
)
130 if (s
->xadc_dfifo_entries
< ZYNQ_XADC_FIFO_DEPTH
) {
131 s
->xadc_dfifo
[s
->xadc_dfifo_entries
++] = s
->xadc_read_reg_previous
;
133 s
->xadc_read_reg_previous
= regval
;
134 zynq_xadc_update_ints(s
);
137 static bool zynq_xadc_check_offset(hwaddr offset
, bool rnw
)
147 return rnw
; /* read only */
149 return !rnw
; /* write only */
155 static uint64_t zynq_xadc_read(void *opaque
, hwaddr offset
, unsigned size
)
157 ZynqXADCState
*s
= opaque
;
158 int reg
= offset
/ 4;
161 if (!zynq_xadc_check_offset(reg
, true)) {
162 qemu_log_mask(LOG_GUEST_ERROR
, "zynq_xadc: Invalid read access to "
163 "addr %" HWADDR_PRIx
"\n", offset
);
176 rv
|= s
->xadc_dfifo_entries
<< MSTS_DFIFO_LVL_SHIFT
;
177 if (!s
->xadc_dfifo_entries
) {
179 } else if (s
->xadc_dfifo_entries
== ZYNQ_XADC_FIFO_DEPTH
) {
184 rv
= xadc_pop_dfifo(s
);
190 static void zynq_xadc_write(void *opaque
, hwaddr offset
, uint64_t val
,
193 ZynqXADCState
*s
= (ZynqXADCState
*)opaque
;
194 int reg
= offset
/ 4;
199 if (!zynq_xadc_check_offset(reg
, false)) {
200 qemu_log_mask(LOG_GUEST_ERROR
, "zynq_xadc: Invalid write access "
201 "to addr %" HWADDR_PRIx
"\n", offset
);
210 s
->regs
[INT_STS
] &= ~val
;
213 s
->regs
[INT_MASK
] = val
& INT_ALL
;
216 xadc_cmd
= extract32(val
, 26, 4);
217 xadc_reg
= extract32(val
, 16, 10);
218 xadc_data
= extract32(val
, 0, 16);
220 if (s
->regs
[MCTL
] & MCTL_RESET
) {
221 qemu_log_mask(LOG_GUEST_ERROR
, "zynq_xadc: Sending command "
222 "while comm channel held in reset: %" PRIx32
"\n",
227 if (xadc_reg
>= ZYNQ_XADC_NUM_ADC_REGS
&& xadc_cmd
!= CMD_NOP
) {
228 qemu_log_mask(LOG_GUEST_ERROR
, "read/write op to invalid xadc "
229 "reg 0x%x\n", xadc_reg
);
235 xadc_push_dfifo(s
, s
->xadc_regs
[xadc_reg
]);
238 s
->xadc_regs
[xadc_reg
] = xadc_data
;
241 xadc_push_dfifo(s
, 0);
246 s
->regs
[MCTL
] = val
& 0x00fffeff;
249 zynq_xadc_update_ints(s
);
252 static const MemoryRegionOps xadc_ops
= {
253 .read
= zynq_xadc_read
,
254 .write
= zynq_xadc_write
,
255 .endianness
= DEVICE_NATIVE_ENDIAN
,
258 static void zynq_xadc_init(Object
*obj
)
260 SysBusDevice
*sbd
= SYS_BUS_DEVICE(obj
);
261 ZynqXADCState
*s
= ZYNQ_XADC(obj
);
263 memory_region_init_io(&s
->iomem
, obj
, &xadc_ops
, s
, "zynq-xadc",
264 ZYNQ_XADC_MMIO_SIZE
);
265 sysbus_init_mmio(sbd
, &s
->iomem
);
266 sysbus_init_irq(sbd
, &s
->qemu_irq
);
269 static const VMStateDescription vmstate_zynq_xadc
= {
272 .minimum_version_id
= 1,
273 .fields
= (VMStateField
[]) {
274 VMSTATE_UINT32_ARRAY(regs
, ZynqXADCState
, ZYNQ_XADC_NUM_IO_REGS
),
275 VMSTATE_UINT16_ARRAY(xadc_regs
, ZynqXADCState
,
276 ZYNQ_XADC_NUM_ADC_REGS
),
277 VMSTATE_UINT16_ARRAY(xadc_dfifo
, ZynqXADCState
,
278 ZYNQ_XADC_FIFO_DEPTH
),
279 VMSTATE_UINT16(xadc_read_reg_previous
, ZynqXADCState
),
280 VMSTATE_UINT16(xadc_dfifo_entries
, ZynqXADCState
),
281 VMSTATE_END_OF_LIST()
285 static void zynq_xadc_class_init(ObjectClass
*klass
, void *data
)
287 DeviceClass
*dc
= DEVICE_CLASS(klass
);
289 dc
->vmsd
= &vmstate_zynq_xadc
;
290 dc
->reset
= zynq_xadc_reset
;
293 static const TypeInfo zynq_xadc_info
= {
294 .class_init
= zynq_xadc_class_init
,
295 .name
= TYPE_ZYNQ_XADC
,
296 .parent
= TYPE_SYS_BUS_DEVICE
,
297 .instance_size
= sizeof(ZynqXADCState
),
298 .instance_init
= zynq_xadc_init
,
301 static void zynq_xadc_register_types(void)
303 type_register_static(&zynq_xadc_info
);
306 type_init(zynq_xadc_register_types
)