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
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
25 #if TARGET_PHYS_ADDR_BITS == 32
26 #define REG_FMT "0x%02x"
28 #define REG_FMT "0x%02lx"
34 target_phys_addr_t target_base;
51 #define SCOOP_MCR 0x00
52 #define SCOOP_CDR 0x04
53 #define SCOOP_CSR 0x08
54 #define SCOOP_CPR 0x0c
55 #define SCOOP_CCR 0x10
56 #define SCOOP_IRR_IRM 0x14
57 #define SCOOP_IMR 0x18
58 #define SCOOP_ISR 0x1c
59 #define SCOOP_GPCR 0x20
60 #define SCOOP_GPWR 0x24
61 #define SCOOP_GPRR 0x28
63 static inline void scoop_gpio_handler_update(struct scoop_info_s *s) {
66 level = s->gpio_level & s->gpio_dir;
68 for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
70 qemu_set_irq(s->handler[bit], (level >> bit) & 1);
73 s->prev_level = level;
76 static uint32_t scoop_readb(void *opaque, target_phys_addr_t addr)
78 struct scoop_info_s *s = (struct scoop_info_s *) opaque;
79 addr -= s->target_base;
102 return s->gpio_level;
104 zaurus_printf("Bad register offset " REG_FMT "\n", addr);
110 static void scoop_writeb(void *opaque, target_phys_addr_t addr, uint32_t value)
112 struct scoop_info_s *s = (struct scoop_info_s *) opaque;
113 addr -= s->target_base;
142 scoop_gpio_handler_update(s);
145 case SCOOP_GPRR: /* GPRR is probably R/O in real HW */
146 s->gpio_level = value & s->gpio_dir;
147 scoop_gpio_handler_update(s);
150 zaurus_printf("Bad register offset " REG_FMT "\n", addr);
154 static CPUReadMemoryFunc *scoop_readfn[] = {
159 static CPUWriteMemoryFunc *scoop_writefn[] = {
165 void scoop_gpio_set(void *opaque, int line, int level)
167 struct scoop_info_s *s = (struct scoop_info_s *) s;
170 s->gpio_level |= (1 << line);
172 s->gpio_level &= ~(1 << line);
175 qemu_irq *scoop_gpio_in_get(struct scoop_info_s *s)
180 void scoop_gpio_out_set(struct scoop_info_s *s, int line,
183 fprintf(stderr, "No GPIO pin %i\n", line);
187 s->handler[line] = handler;
190 static void scoop_save(QEMUFile *f, void *opaque)
192 struct scoop_info_s *s = (struct scoop_info_s *) opaque;
193 qemu_put_be16s(f, &s->status);
194 qemu_put_be16s(f, &s->power);
195 qemu_put_be32s(f, &s->gpio_level);
196 qemu_put_be32s(f, &s->gpio_dir);
197 qemu_put_be32s(f, &s->prev_level);
198 qemu_put_be16s(f, &s->mcr);
199 qemu_put_be16s(f, &s->cdr);
200 qemu_put_be16s(f, &s->ccr);
201 qemu_put_be16s(f, &s->irr);
202 qemu_put_be16s(f, &s->imr);
203 qemu_put_be16s(f, &s->isr);
206 static int scoop_load(QEMUFile *f, void *opaque, int version_id)
209 struct scoop_info_s *s = (struct scoop_info_s *) opaque;
210 qemu_get_be16s(f, &s->status);
211 qemu_get_be16s(f, &s->power);
212 qemu_get_be32s(f, &s->gpio_level);
213 qemu_get_be32s(f, &s->gpio_dir);
214 qemu_get_be32s(f, &s->prev_level);
215 qemu_get_be16s(f, &s->mcr);
216 qemu_get_be16s(f, &s->cdr);
217 qemu_get_be16s(f, &s->ccr);
218 qemu_get_be16s(f, &s->irr);
219 qemu_get_be16s(f, &s->imr);
220 qemu_get_be16s(f, &s->isr);
222 qemu_get_be16s(f, &dummy);
227 struct scoop_info_s *scoop_init(struct pxa2xx_state_s *cpu,
229 target_phys_addr_t target_base) {
231 struct scoop_info_s *s;
233 s = (struct scoop_info_s *)
234 qemu_mallocz(sizeof(struct scoop_info_s));
235 memset(s, 0, sizeof(struct scoop_info_s));
237 s->target_base = target_base;
239 s->in = qemu_allocate_irqs(scoop_gpio_set, s, 16);
240 iomemtype = cpu_register_io_memory(0, scoop_readfn,
242 cpu_register_physical_memory(s->target_base, 0x1000, iomemtype);
243 register_savevm("scoop", instance, 1, scoop_save, scoop_load, s);
248 /* Write the bootloader parameters memory area. */
250 #define MAGIC_CHG(a, b, c, d) ((d << 24) | (c << 16) | (b << 8) | a)
252 static struct __attribute__ ((__packed__)) sl_param_info {
253 uint32_t comadj_keyword;
256 uint32_t uuid_keyword;
259 uint32_t touch_keyword;
265 uint32_t adadj_keyword;
268 uint32_t phad_keyword;
270 } zaurus_bootparam = {
271 .comadj_keyword = MAGIC_CHG('C', 'M', 'A', 'D'),
273 .uuid_keyword = MAGIC_CHG('U', 'U', 'I', 'D'),
275 .touch_keyword = MAGIC_CHG('T', 'U', 'C', 'H'),
277 .adadj_keyword = MAGIC_CHG('B', 'V', 'A', 'D'),
279 .phad_keyword = MAGIC_CHG('P', 'H', 'A', 'D'),
283 void sl_bootparam_write(uint32_t ptr)
285 memcpy(phys_ram_base + ptr, &zaurus_bootparam,
286 sizeof(struct sl_param_info));