1 /*
2 * STM32F2XX ADC
3 *
4 * Copyright (c) 2014 Alistair Francis <alistair@alistair23.me>
5 *
6 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 * of this software and associated documentation files (the "Software"), to deal
8 * in the Software without restriction, including without limitation the rights
9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10 * copies of the Software, and to permit persons to whom the Software is
11 * furnished to do so, subject to the following conditions:
12 *
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
15 *
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22 * THE SOFTWARE.
23 */
24
25 #include "qemu/osdep.h"
26 #include "hw/sysbus.h"
27 #include "migration/vmstate.h"
28 #include "qemu/log.h"
29 #include "qemu/module.h"
30 #include "hw/adc/stm32f2xx_adc.h"
31
32 #ifndef STM_ADC_ERR_DEBUG
33 #define STM_ADC_ERR_DEBUG 0
34 #endif
35
36 #define DB_PRINT_L(lvl, fmt, args...) do { \
37 if (STM_ADC_ERR_DEBUG >= lvl) { \
38 qemu_log("%s: " fmt, __func__, ## args); \
39 } \
40 } while (0)
41
42 #define DB_PRINT(fmt, args...) DB_PRINT_L(1, fmt, ## args)
43
stm32f2xx_adc_reset(DeviceState * dev)44 static void stm32f2xx_adc_reset(DeviceState *dev)
45 {
46 STM32F2XXADCState *s = STM32F2XX_ADC(dev);
47
48 s->adc_sr = 0x00000000;
49 s->adc_cr1 = 0x00000000;
50 s->adc_cr2 = 0x00000000;
51 s->adc_smpr1 = 0x00000000;
52 s->adc_smpr2 = 0x00000000;
53 s->adc_jofr[0] = 0x00000000;
54 s->adc_jofr[1] = 0x00000000;
55 s->adc_jofr[2] = 0x00000000;
56 s->adc_jofr[3] = 0x00000000;
57 s->adc_htr = 0x00000FFF;
58 s->adc_ltr = 0x00000000;
59 s->adc_sqr1 = 0x00000000;
60 s->adc_sqr2 = 0x00000000;
61 s->adc_sqr3 = 0x00000000;
62 s->adc_jsqr = 0x00000000;
63 s->adc_jdr[0] = 0x00000000;
64 s->adc_jdr[1] = 0x00000000;
65 s->adc_jdr[2] = 0x00000000;
66 s->adc_jdr[3] = 0x00000000;
67 s->adc_dr = 0x00000000;
68 }
69
stm32f2xx_adc_generate_value(STM32F2XXADCState * s)70 static uint32_t stm32f2xx_adc_generate_value(STM32F2XXADCState *s)
71 {
72 /* Attempts to fake some ADC values */
73 s->adc_dr = s->adc_dr + 7;
74
75 switch ((s->adc_cr1 & ADC_CR1_RES) >> 24) {
76 case 0:
77 /* 12-bit */
78 s->adc_dr &= 0xFFF;
79 break;
80 case 1:
81 /* 10-bit */
82 s->adc_dr &= 0x3FF;
83 break;
84 case 2:
85 /* 8-bit */
86 s->adc_dr &= 0xFF;
87 break;
88 default:
89 /* 6-bit */
90 s->adc_dr &= 0x3F;
91 }
92
93 if (s->adc_cr2 & ADC_CR2_ALIGN) {
94 return (s->adc_dr << 1) & 0xFFF0;
95 } else {
96 return s->adc_dr;
97 }
98 }
99
stm32f2xx_adc_read(void * opaque,hwaddr addr,unsigned int size)100 static uint64_t stm32f2xx_adc_read(void *opaque, hwaddr addr,
101 unsigned int size)
102 {
103 STM32F2XXADCState *s = opaque;
104
105 DB_PRINT("Address: 0x%" HWADDR_PRIx "\n", addr);
106
107 if (addr >= ADC_COMMON_ADDRESS) {
108 qemu_log_mask(LOG_UNIMP,
109 "%s: ADC Common Register Unsupported\n", __func__);
110 }
111
112 switch (addr) {
113 case ADC_SR:
114 return s->adc_sr;
115 case ADC_CR1:
116 return s->adc_cr1;
117 case ADC_CR2:
118 return s->adc_cr2 & 0xFFFFFFF;
119 case ADC_SMPR1:
120 return s->adc_smpr1;
121 case ADC_SMPR2:
122 return s->adc_smpr2;
123 case ADC_JOFR1:
124 case ADC_JOFR2:
125 case ADC_JOFR3:
126 case ADC_JOFR4:
127 qemu_log_mask(LOG_UNIMP, "%s: " \
128 "Injection ADC is not implemented, the registers are " \
129 "included for compatibility\n", __func__);
130 return s->adc_jofr[(addr - ADC_JOFR1) / 4];
131 case ADC_HTR:
132 return s->adc_htr;
133 case ADC_LTR:
134 return s->adc_ltr;
135 case ADC_SQR1:
136 return s->adc_sqr1;
137 case ADC_SQR2:
138 return s->adc_sqr2;
139 case ADC_SQR3:
140 return s->adc_sqr3;
141 case ADC_JSQR:
142 qemu_log_mask(LOG_UNIMP, "%s: " \
143 "Injection ADC is not implemented, the registers are " \
144 "included for compatibility\n", __func__);
145 return s->adc_jsqr;
146 case ADC_JDR1:
147 case ADC_JDR2:
148 case ADC_JDR3:
149 case ADC_JDR4:
150 qemu_log_mask(LOG_UNIMP, "%s: " \
151 "Injection ADC is not implemented, the registers are " \
152 "included for compatibility\n", __func__);
153 return s->adc_jdr[(addr - ADC_JDR1) / 4] -
154 s->adc_jofr[(addr - ADC_JDR1) / 4];
155 case ADC_DR:
156 if ((s->adc_cr2 & ADC_CR2_ADON) && (s->adc_cr2 & ADC_CR2_SWSTART)) {
157 s->adc_cr2 ^= ADC_CR2_SWSTART;
158 return stm32f2xx_adc_generate_value(s);
159 } else {
160 return 0;
161 }
162 default:
163 qemu_log_mask(LOG_GUEST_ERROR,
164 "%s: Bad offset 0x%" HWADDR_PRIx "\n", __func__, addr);
165 }
166
167 return 0;
168 }
169
stm32f2xx_adc_write(void * opaque,hwaddr addr,uint64_t val64,unsigned int size)170 static void stm32f2xx_adc_write(void *opaque, hwaddr addr,
171 uint64_t val64, unsigned int size)
172 {
173 STM32F2XXADCState *s = opaque;
174 uint32_t value = (uint32_t) val64;
175
176 DB_PRINT("Address: 0x%" HWADDR_PRIx ", Value: 0x%x\n",
177 addr, value);
178
179 if (addr >= 0x100) {
180 qemu_log_mask(LOG_UNIMP,
181 "%s: ADC Common Register Unsupported\n", __func__);
182 }
183
184 switch (addr) {
185 case ADC_SR:
186 s->adc_sr &= (value & 0x3F);
187 break;
188 case ADC_CR1:
189 s->adc_cr1 = value;
190 break;
191 case ADC_CR2:
192 s->adc_cr2 = value;
193 break;
194 case ADC_SMPR1:
195 s->adc_smpr1 = value;
196 break;
197 case ADC_SMPR2:
198 s->adc_smpr2 = value;
199 break;
200 case ADC_JOFR1:
201 case ADC_JOFR2:
202 case ADC_JOFR3:
203 case ADC_JOFR4:
204 s->adc_jofr[(addr - ADC_JOFR1) / 4] = (value & 0xFFF);
205 qemu_log_mask(LOG_UNIMP, "%s: " \
206 "Injection ADC is not implemented, the registers are " \
207 "included for compatibility\n", __func__);
208 break;
209 case ADC_HTR:
210 s->adc_htr = value;
211 break;
212 case ADC_LTR:
213 s->adc_ltr = value;
214 break;
215 case ADC_SQR1:
216 s->adc_sqr1 = value;
217 break;
218 case ADC_SQR2:
219 s->adc_sqr2 = value;
220 break;
221 case ADC_SQR3:
222 s->adc_sqr3 = value;
223 break;
224 case ADC_JSQR:
225 s->adc_jsqr = value;
226 qemu_log_mask(LOG_UNIMP, "%s: " \
227 "Injection ADC is not implemented, the registers are " \
228 "included for compatibility\n", __func__);
229 break;
230 case ADC_JDR1:
231 case ADC_JDR2:
232 case ADC_JDR3:
233 case ADC_JDR4:
234 s->adc_jdr[(addr - ADC_JDR1) / 4] = value;
235 qemu_log_mask(LOG_UNIMP, "%s: " \
236 "Injection ADC is not implemented, the registers are " \
237 "included for compatibility\n", __func__);
238 break;
239 default:
240 qemu_log_mask(LOG_GUEST_ERROR,
241 "%s: Bad offset 0x%" HWADDR_PRIx "\n", __func__, addr);
242 }
243 }
244
245 static const MemoryRegionOps stm32f2xx_adc_ops = {
246 .read = stm32f2xx_adc_read,
247 .write = stm32f2xx_adc_write,
248 .endianness = DEVICE_NATIVE_ENDIAN,
249 .impl.min_access_size = 4,
250 .impl.max_access_size = 4,
251 };
252
253 static const VMStateDescription vmstate_stm32f2xx_adc = {
254 .name = TYPE_STM32F2XX_ADC,
255 .version_id = 1,
256 .minimum_version_id = 1,
257 .fields = (const VMStateField[]) {
258 VMSTATE_UINT32(adc_sr, STM32F2XXADCState),
259 VMSTATE_UINT32(adc_cr1, STM32F2XXADCState),
260 VMSTATE_UINT32(adc_cr2, STM32F2XXADCState),
261 VMSTATE_UINT32(adc_smpr1, STM32F2XXADCState),
262 VMSTATE_UINT32(adc_smpr2, STM32F2XXADCState),
263 VMSTATE_UINT32_ARRAY(adc_jofr, STM32F2XXADCState, 4),
264 VMSTATE_UINT32(adc_htr, STM32F2XXADCState),
265 VMSTATE_UINT32(adc_ltr, STM32F2XXADCState),
266 VMSTATE_UINT32(adc_sqr1, STM32F2XXADCState),
267 VMSTATE_UINT32(adc_sqr2, STM32F2XXADCState),
268 VMSTATE_UINT32(adc_sqr3, STM32F2XXADCState),
269 VMSTATE_UINT32(adc_jsqr, STM32F2XXADCState),
270 VMSTATE_UINT32_ARRAY(adc_jdr, STM32F2XXADCState, 4),
271 VMSTATE_UINT32(adc_dr, STM32F2XXADCState),
272 VMSTATE_END_OF_LIST()
273 }
274 };
275
stm32f2xx_adc_init(Object * obj)276 static void stm32f2xx_adc_init(Object *obj)
277 {
278 STM32F2XXADCState *s = STM32F2XX_ADC(obj);
279
280 sysbus_init_irq(SYS_BUS_DEVICE(obj), &s->irq);
281
282 memory_region_init_io(&s->mmio, obj, &stm32f2xx_adc_ops, s,
283 TYPE_STM32F2XX_ADC, 0x100);
284 sysbus_init_mmio(SYS_BUS_DEVICE(obj), &s->mmio);
285 }
286
stm32f2xx_adc_class_init(ObjectClass * klass,void * data)287 static void stm32f2xx_adc_class_init(ObjectClass *klass, void *data)
288 {
289 DeviceClass *dc = DEVICE_CLASS(klass);
290
291 dc->reset = stm32f2xx_adc_reset;
292 dc->vmsd = &vmstate_stm32f2xx_adc;
293 }
294
295 static const TypeInfo stm32f2xx_adc_info = {
296 .name = TYPE_STM32F2XX_ADC,
297 .parent = TYPE_SYS_BUS_DEVICE,
298 .instance_size = sizeof(STM32F2XXADCState),
299 .instance_init = stm32f2xx_adc_init,
300 .class_init = stm32f2xx_adc_class_init,
301 };
302
stm32f2xx_adc_register_types(void)303 static void stm32f2xx_adc_register_types(void)
304 {
305 type_register_static(&stm32f2xx_adc_info);
306 }
307
308 type_init(stm32f2xx_adc_register_types)
309