2 * Copyright (c) 2006-2008 Openedhand Ltd.
3 * Written by Andrzej Zaborowski <balrog@zabor.org>
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License as
7 * published by the Free Software Foundation; either version 2 or
8 * (at your option) version 3 of the License.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, see <http://www.gnu.org/licenses/>.
24 #define REG_FMT "0x%02lx"
28 typedef struct ScoopInfo ScoopInfo;
46 #define SCOOP_MCR 0x00
47 #define SCOOP_CDR 0x04
48 #define SCOOP_CSR 0x08
49 #define SCOOP_CPR 0x0c
50 #define SCOOP_CCR 0x10
51 #define SCOOP_IRR_IRM 0x14
52 #define SCOOP_IMR 0x18
53 #define SCOOP_ISR 0x1c
54 #define SCOOP_GPCR 0x20
55 #define SCOOP_GPWR 0x24
56 #define SCOOP_GPRR 0x28
58 static inline void scoop_gpio_handler_update(ScoopInfo *s) {
61 level = s->gpio_level & s->gpio_dir;
63 for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
65 qemu_set_irq(s->handler[bit], (level >> bit) & 1);
68 s->prev_level = level;
71 static uint32_t scoop_readb(void *opaque, target_phys_addr_t addr)
73 ScoopInfo *s = (ScoopInfo *) opaque;
75 switch (addr & 0x3f) {
98 zaurus_printf("Bad register offset " REG_FMT "\n", (unsigned long)addr);
104 static void scoop_writeb(void *opaque, target_phys_addr_t addr, uint32_t value)
106 ScoopInfo *s = (ScoopInfo *) opaque;
109 switch (addr & 0x3f) {
135 scoop_gpio_handler_update(s);
138 case SCOOP_GPRR: /* GPRR is probably R/O in real HW */
139 s->gpio_level = value & s->gpio_dir;
140 scoop_gpio_handler_update(s);
143 zaurus_printf("Bad register offset " REG_FMT "\n", (unsigned long)addr);
147 static CPUReadMemoryFunc * const scoop_readfn[] = {
152 static CPUWriteMemoryFunc * const scoop_writefn[] = {
158 static void scoop_gpio_set(void *opaque, int line, int level)
160 ScoopInfo *s = (ScoopInfo *) opaque;
163 s->gpio_level |= (1 << line);
165 s->gpio_level &= ~(1 << line);
168 static int scoop_init(SysBusDevice *dev)
170 ScoopInfo *s = FROM_SYSBUS(ScoopInfo, dev);
174 qdev_init_gpio_out(&s->busdev.qdev, s->handler, 16);
175 qdev_init_gpio_in(&s->busdev.qdev, scoop_gpio_set, 16);
176 iomemtype = cpu_register_io_memory(scoop_readfn,
177 scoop_writefn, s, DEVICE_NATIVE_ENDIAN);
179 sysbus_init_mmio(dev, 0x1000, iomemtype);
184 static bool is_version_0 (void *opaque, int version_id)
186 return version_id == 0;
190 static const VMStateDescription vmstate_scoop_regs = {
193 .minimum_version_id = 0,
194 .minimum_version_id_old = 0,
195 .fields = (VMStateField []) {
196 VMSTATE_UINT16(status, ScoopInfo),
197 VMSTATE_UINT16(power, ScoopInfo),
198 VMSTATE_UINT32(gpio_level, ScoopInfo),
199 VMSTATE_UINT32(gpio_dir, ScoopInfo),
200 VMSTATE_UINT32(prev_level, ScoopInfo),
201 VMSTATE_UINT16(mcr, ScoopInfo),
202 VMSTATE_UINT16(cdr, ScoopInfo),
203 VMSTATE_UINT16(ccr, ScoopInfo),
204 VMSTATE_UINT16(irr, ScoopInfo),
205 VMSTATE_UINT16(imr, ScoopInfo),
206 VMSTATE_UINT16(isr, ScoopInfo),
207 VMSTATE_UNUSED_TEST(is_version_0, 2),
208 VMSTATE_END_OF_LIST(),
212 static SysBusDeviceInfo scoop_sysbus_info = {
214 .qdev.name = "scoop",
215 .qdev.desc = "Scoop2 Sharp custom ASIC",
216 .qdev.size = sizeof(ScoopInfo),
217 .qdev.vmsd = &vmstate_scoop_regs,
218 .qdev.props = (Property[]) {
219 DEFINE_PROP_END_OF_LIST(),
223 static void scoop_register(void)
225 sysbus_register_withprop(&scoop_sysbus_info);
227 device_init(scoop_register);
229 /* Write the bootloader parameters memory area. */
231 #define MAGIC_CHG(a, b, c, d) ((d << 24) | (c << 16) | (b << 8) | a)
233 static struct __attribute__ ((__packed__)) sl_param_info {
234 uint32_t comadj_keyword;
237 uint32_t uuid_keyword;
240 uint32_t touch_keyword;
246 uint32_t adadj_keyword;
249 uint32_t phad_keyword;
251 } zaurus_bootparam = {
252 .comadj_keyword = MAGIC_CHG('C', 'M', 'A', 'D'),
254 .uuid_keyword = MAGIC_CHG('U', 'U', 'I', 'D'),
256 .touch_keyword = MAGIC_CHG('T', 'U', 'C', 'H'),
258 .adadj_keyword = MAGIC_CHG('B', 'V', 'A', 'D'),
260 .phad_keyword = MAGIC_CHG('P', 'H', 'A', 'D'),
264 void sl_bootparam_write(target_phys_addr_t ptr)
266 cpu_physical_memory_write(ptr, (void *)&zaurus_bootparam,
267 sizeof(struct sl_param_info));