softfloat: use GCC builtins to count the leading zeros
[qemu.git] / hw / tosa.c
bloba7967a286ea5e2835370fda15d1672388fab3386
1 /* vim:set shiftwidth=4 ts=4 et: */
2 /*
3 * PXA255 Sharp Zaurus SL-6000 PDA platform
5 * Copyright (c) 2008 Dmitry Baryshkov
7 * Code based on spitz platform by Andrzej Zaborowski <balrog@zabor.org>
8 * This code is licensed under the GNU GPL v2.
9 */
11 #include "hw.h"
12 #include "pxa.h"
13 #include "arm-misc.h"
14 #include "devices.h"
15 #include "sharpsl.h"
16 #include "pcmcia.h"
17 #include "block.h"
18 #include "boards.h"
19 #include "i2c.h"
20 #include "ssi.h"
21 #include "blockdev.h"
22 #include "sysbus.h"
24 #define TOSA_RAM 0x04000000
25 #define TOSA_ROM 0x00800000
27 #define TOSA_GPIO_USB_IN (5)
28 #define TOSA_GPIO_nSD_DETECT (9)
29 #define TOSA_GPIO_ON_RESET (19)
30 #define TOSA_GPIO_CF_IRQ (21) /* CF slot0 Ready */
31 #define TOSA_GPIO_CF_CD (13)
32 #define TOSA_GPIO_TC6393XB_INT (15)
33 #define TOSA_GPIO_JC_CF_IRQ (36) /* CF slot1 Ready */
35 #define TOSA_SCOOP_GPIO_BASE 1
36 #define TOSA_GPIO_IR_POWERDWN (TOSA_SCOOP_GPIO_BASE + 2)
37 #define TOSA_GPIO_SD_WP (TOSA_SCOOP_GPIO_BASE + 3)
38 #define TOSA_GPIO_PWR_ON (TOSA_SCOOP_GPIO_BASE + 4)
40 #define TOSA_SCOOP_JC_GPIO_BASE 1
41 #define TOSA_GPIO_BT_LED (TOSA_SCOOP_JC_GPIO_BASE + 0)
42 #define TOSA_GPIO_NOTE_LED (TOSA_SCOOP_JC_GPIO_BASE + 1)
43 #define TOSA_GPIO_CHRG_ERR_LED (TOSA_SCOOP_JC_GPIO_BASE + 2)
44 #define TOSA_GPIO_TC6393XB_L3V_ON (TOSA_SCOOP_JC_GPIO_BASE + 5)
45 #define TOSA_GPIO_WLAN_LED (TOSA_SCOOP_JC_GPIO_BASE + 7)
47 #define DAC_BASE 0x4e
48 #define DAC_CH1 0
49 #define DAC_CH2 1
51 static void tosa_microdrive_attach(PXA2xxState *cpu)
53 PCMCIACardState *md;
54 BlockDriverState *bs;
55 DriveInfo *dinfo;
57 dinfo = drive_get(IF_IDE, 0, 0);
58 if (!dinfo)
59 return;
60 bs = dinfo->bdrv;
61 if (bdrv_is_inserted(bs) && !bdrv_is_removable(bs)) {
62 md = dscm1xxxx_init(dinfo);
63 pxa2xx_pcmcia_attach(cpu->pcmcia[0], md);
67 static void tosa_out_switch(void *opaque, int line, int level)
69 switch (line) {
70 case 0:
71 fprintf(stderr, "blue LED %s.\n", level ? "on" : "off");
72 break;
73 case 1:
74 fprintf(stderr, "green LED %s.\n", level ? "on" : "off");
75 break;
76 case 2:
77 fprintf(stderr, "amber LED %s.\n", level ? "on" : "off");
78 break;
79 case 3:
80 fprintf(stderr, "wlan LED %s.\n", level ? "on" : "off");
81 break;
82 default:
83 fprintf(stderr, "Uhandled out event: %d = %d\n", line, level);
84 break;
89 static void tosa_gpio_setup(PXA2xxState *cpu,
90 DeviceState *scp0,
91 DeviceState *scp1,
92 TC6393xbState *tmio)
94 qemu_irq *outsignals = qemu_allocate_irqs(tosa_out_switch, cpu, 4);
95 /* MMC/SD host */
96 pxa2xx_mmci_handlers(cpu->mmc,
97 qdev_get_gpio_in(scp0, TOSA_GPIO_SD_WP),
98 qemu_irq_invert(qdev_get_gpio_in(cpu->gpio, TOSA_GPIO_nSD_DETECT)));
100 /* Handle reset */
101 qdev_connect_gpio_out(cpu->gpio, TOSA_GPIO_ON_RESET, cpu->reset);
103 /* PCMCIA signals: card's IRQ and Card-Detect */
104 pxa2xx_pcmcia_set_irq_cb(cpu->pcmcia[0],
105 qdev_get_gpio_in(cpu->gpio, TOSA_GPIO_CF_IRQ),
106 qdev_get_gpio_in(cpu->gpio, TOSA_GPIO_CF_CD));
108 pxa2xx_pcmcia_set_irq_cb(cpu->pcmcia[1],
109 qdev_get_gpio_in(cpu->gpio, TOSA_GPIO_JC_CF_IRQ),
110 NULL);
112 qdev_connect_gpio_out(scp1, TOSA_GPIO_BT_LED, outsignals[0]);
113 qdev_connect_gpio_out(scp1, TOSA_GPIO_NOTE_LED, outsignals[1]);
114 qdev_connect_gpio_out(scp1, TOSA_GPIO_CHRG_ERR_LED, outsignals[2]);
115 qdev_connect_gpio_out(scp1, TOSA_GPIO_WLAN_LED, outsignals[3]);
117 qdev_connect_gpio_out(scp1, TOSA_GPIO_TC6393XB_L3V_ON, tc6393xb_l3v_get(tmio));
119 /* UDC Vbus */
120 qemu_irq_raise(qdev_get_gpio_in(cpu->gpio, TOSA_GPIO_USB_IN));
123 static uint32_t tosa_ssp_tansfer(SSISlave *dev, uint32_t value)
125 fprintf(stderr, "TG: %d %02x\n", value >> 5, value & 0x1f);
126 return 0;
129 static int tosa_ssp_init(SSISlave *dev)
131 /* Nothing to do. */
132 return 0;
135 typedef struct {
136 i2c_slave i2c;
137 int len;
138 char buf[3];
139 } TosaDACState;
141 static int tosa_dac_send(i2c_slave *i2c, uint8_t data)
143 TosaDACState *s = FROM_I2C_SLAVE(TosaDACState, i2c);
144 s->buf[s->len] = data;
145 if (s->len ++ > 2) {
146 #ifdef VERBOSE
147 fprintf(stderr, "%s: message too long (%i bytes)\n", __FUNCTION__, s->len);
148 #endif
149 return 1;
152 if (s->len == 2) {
153 fprintf(stderr, "dac: channel %d value 0x%02x\n",
154 s->buf[0], s->buf[1]);
157 return 0;
160 static void tosa_dac_event(i2c_slave *i2c, enum i2c_event event)
162 TosaDACState *s = FROM_I2C_SLAVE(TosaDACState, i2c);
163 s->len = 0;
164 switch (event) {
165 case I2C_START_SEND:
166 break;
167 case I2C_START_RECV:
168 printf("%s: recv not supported!!!\n", __FUNCTION__);
169 break;
170 case I2C_FINISH:
171 #ifdef VERBOSE
172 if (s->len < 2)
173 printf("%s: message too short (%i bytes)\n", __FUNCTION__, s->len);
174 if (s->len > 2)
175 printf("%s: message too long\n", __FUNCTION__);
176 #endif
177 break;
178 default:
179 break;
183 static int tosa_dac_recv(i2c_slave *s)
185 printf("%s: recv not supported!!!\n", __FUNCTION__);
186 return -1;
189 static int tosa_dac_init(i2c_slave *i2c)
191 /* Nothing to do. */
192 return 0;
195 static void tosa_tg_init(PXA2xxState *cpu)
197 i2c_bus *bus = pxa2xx_i2c_bus(cpu->i2c[0]);
198 i2c_create_slave(bus, "tosa_dac", DAC_BASE);
199 ssi_create_slave(cpu->ssp[1], "tosa-ssp");
203 static struct arm_boot_info tosa_binfo = {
204 .loader_start = PXA2XX_SDRAM_BASE,
205 .ram_size = 0x04000000,
208 static void tosa_init(ram_addr_t ram_size,
209 const char *boot_device,
210 const char *kernel_filename, const char *kernel_cmdline,
211 const char *initrd_filename, const char *cpu_model)
213 PXA2xxState *cpu;
214 TC6393xbState *tmio;
215 DeviceState *scp0, *scp1;
217 if (!cpu_model)
218 cpu_model = "pxa255";
220 cpu = pxa255_init(tosa_binfo.ram_size);
222 cpu_register_physical_memory(0, TOSA_ROM,
223 qemu_ram_alloc(NULL, "tosa.rom", TOSA_ROM) | IO_MEM_ROM);
225 tmio = tc6393xb_init(0x10000000,
226 qdev_get_gpio_in(cpu->gpio, TOSA_GPIO_TC6393XB_INT));
228 scp0 = sysbus_create_simple("scoop", 0x08800000, NULL);
229 scp1 = sysbus_create_simple("scoop", 0x14800040, NULL);
231 tosa_gpio_setup(cpu, scp0, scp1, tmio);
233 tosa_microdrive_attach(cpu);
235 tosa_tg_init(cpu);
237 tosa_binfo.kernel_filename = kernel_filename;
238 tosa_binfo.kernel_cmdline = kernel_cmdline;
239 tosa_binfo.initrd_filename = initrd_filename;
240 tosa_binfo.board_id = 0x208;
241 arm_load_kernel(cpu->env, &tosa_binfo);
242 sl_bootparam_write(SL_PXA_PARAM_BASE);
245 static QEMUMachine tosapda_machine = {
246 .name = "tosa",
247 .desc = "Tosa PDA (PXA255)",
248 .init = tosa_init,
251 static void tosapda_machine_init(void)
253 qemu_register_machine(&tosapda_machine);
256 machine_init(tosapda_machine_init);
258 static I2CSlaveInfo tosa_dac_info = {
259 .qdev.name = "tosa_dac",
260 .qdev.size = sizeof(TosaDACState),
261 .init = tosa_dac_init,
262 .event = tosa_dac_event,
263 .recv = tosa_dac_recv,
264 .send = tosa_dac_send
267 static SSISlaveInfo tosa_ssp_info = {
268 .qdev.name = "tosa-ssp",
269 .qdev.size = sizeof(SSISlave),
270 .init = tosa_ssp_init,
271 .transfer = tosa_ssp_tansfer
274 static void tosa_register_devices(void)
276 i2c_register_slave(&tosa_dac_info);
277 ssi_register_slave(&tosa_ssp_info);
280 device_init(tosa_register_devices)