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, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
24 #define REG_FMT "0x%02lx"
45 #define SCOOP_MCR 0x00
46 #define SCOOP_CDR 0x04
47 #define SCOOP_CSR 0x08
48 #define SCOOP_CPR 0x0c
49 #define SCOOP_CCR 0x10
50 #define SCOOP_IRR_IRM 0x14
51 #define SCOOP_IMR 0x18
52 #define SCOOP_ISR 0x1c
53 #define SCOOP_GPCR 0x20
54 #define SCOOP_GPWR 0x24
55 #define SCOOP_GPRR 0x28
57 static inline void scoop_gpio_handler_update(ScoopInfo *s) {
60 level = s->gpio_level & s->gpio_dir;
62 for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
64 qemu_set_irq(s->handler[bit], (level >> bit) & 1);
67 s->prev_level = level;
70 static uint32_t scoop_readb(void *opaque, target_phys_addr_t addr)
72 ScoopInfo *s = (ScoopInfo *) opaque;
97 zaurus_printf("Bad register offset " REG_FMT "\n", (unsigned long)addr);
103 static void scoop_writeb(void *opaque, target_phys_addr_t addr, uint32_t value)
105 ScoopInfo *s = (ScoopInfo *) opaque;
134 scoop_gpio_handler_update(s);
137 case SCOOP_GPRR: /* GPRR is probably R/O in real HW */
138 s->gpio_level = value & s->gpio_dir;
139 scoop_gpio_handler_update(s);
142 zaurus_printf("Bad register offset " REG_FMT "\n", (unsigned long)addr);
146 static CPUReadMemoryFunc *scoop_readfn[] = {
151 static CPUWriteMemoryFunc *scoop_writefn[] = {
157 void scoop_gpio_set(void *opaque, int line, int level)
159 ScoopInfo *s = (ScoopInfo *) s;
162 s->gpio_level |= (1 << line);
164 s->gpio_level &= ~(1 << line);
167 qemu_irq *scoop_gpio_in_get(ScoopInfo *s)
172 void scoop_gpio_out_set(ScoopInfo *s, int line,
175 fprintf(stderr, "No GPIO pin %i\n", line);
179 s->handler[line] = handler;
182 static void scoop_save(QEMUFile *f, void *opaque)
184 ScoopInfo *s = (ScoopInfo *) opaque;
185 qemu_put_be16s(f, &s->status);
186 qemu_put_be16s(f, &s->power);
187 qemu_put_be32s(f, &s->gpio_level);
188 qemu_put_be32s(f, &s->gpio_dir);
189 qemu_put_be32s(f, &s->prev_level);
190 qemu_put_be16s(f, &s->mcr);
191 qemu_put_be16s(f, &s->cdr);
192 qemu_put_be16s(f, &s->ccr);
193 qemu_put_be16s(f, &s->irr);
194 qemu_put_be16s(f, &s->imr);
195 qemu_put_be16s(f, &s->isr);
198 static int scoop_load(QEMUFile *f, void *opaque, int version_id)
201 ScoopInfo *s = (ScoopInfo *) opaque;
202 qemu_get_be16s(f, &s->status);
203 qemu_get_be16s(f, &s->power);
204 qemu_get_be32s(f, &s->gpio_level);
205 qemu_get_be32s(f, &s->gpio_dir);
206 qemu_get_be32s(f, &s->prev_level);
207 qemu_get_be16s(f, &s->mcr);
208 qemu_get_be16s(f, &s->cdr);
209 qemu_get_be16s(f, &s->ccr);
210 qemu_get_be16s(f, &s->irr);
211 qemu_get_be16s(f, &s->imr);
212 qemu_get_be16s(f, &s->isr);
214 qemu_get_be16s(f, &dummy);
219 ScoopInfo *scoop_init(PXA2xxState *cpu,
221 target_phys_addr_t target_base) {
226 qemu_mallocz(sizeof(ScoopInfo));
227 memset(s, 0, sizeof(ScoopInfo));
230 s->in = qemu_allocate_irqs(scoop_gpio_set, s, 16);
231 iomemtype = cpu_register_io_memory(0, scoop_readfn,
233 cpu_register_physical_memory(target_base, 0x1000, iomemtype);
234 register_savevm("scoop", instance, 1, scoop_save, scoop_load, s);
239 /* Write the bootloader parameters memory area. */
241 #define MAGIC_CHG(a, b, c, d) ((d << 24) | (c << 16) | (b << 8) | a)
243 static struct __attribute__ ((__packed__)) sl_param_info {
244 uint32_t comadj_keyword;
247 uint32_t uuid_keyword;
250 uint32_t touch_keyword;
256 uint32_t adadj_keyword;
259 uint32_t phad_keyword;
261 } zaurus_bootparam = {
262 .comadj_keyword = MAGIC_CHG('C', 'M', 'A', 'D'),
264 .uuid_keyword = MAGIC_CHG('U', 'U', 'I', 'D'),
266 .touch_keyword = MAGIC_CHG('T', 'U', 'C', 'H'),
268 .adadj_keyword = MAGIC_CHG('B', 'V', 'A', 'D'),
270 .phad_keyword = MAGIC_CHG('P', 'H', 'A', 'D'),
274 void sl_bootparam_write(target_phys_addr_t ptr)
276 cpu_physical_memory_write(ptr, (void *)&zaurus_bootparam,
277 sizeof(struct sl_param_info));