On Wednesday 06 July 2011 16:52:49 Vasily Khoruzhick wrote: > Zipit Z2 is small PXA270 based handheld.
Ping? > Signed-off-by: Vasily Khoruzhick <anars...@gmail.com> > --- > v2: codestyle fixes, added VMStateDescription for LCD device and AER915, > traces clean up. > v3: no changes > v4: no changes > v5: use DPRINTF for debug-related traces, add missing fields to > VMStateDescription for LCD device and AER915 > > Makefile.target | 1 + > hw/z2.c | 358 > +++++++++++++++++++++++++++++++++++++++++++++++++++++++ 2 files changed, > 359 insertions(+), 0 deletions(-) > create mode 100644 hw/z2.c > > diff --git a/Makefile.target b/Makefile.target > index a53a2ff..9ed230d 100644 > --- a/Makefile.target > +++ b/Makefile.target > @@ -360,6 +360,7 @@ obj-arm-y += omap2.o omap_dss.o soc_dma.o > omap_gptimer.o omap_synctimer.o \ obj-arm-y += omap_sx1.o palm.o tsc210x.o > obj-arm-y += nseries.o blizzard.o onenand.o vga.o cbus.o tusb6010.o > usb-musb.o obj-arm-y += mst_fpga.o mainstone.o > +obj-arm-y += z2.o > obj-arm-y += musicpal.o bitbang_i2c.o marvell_88w8618_audio.o > obj-arm-y += framebuffer.o > obj-arm-y += syborg.o syborg_fb.o syborg_interrupt.o syborg_keyboard.o > diff --git a/hw/z2.c b/hw/z2.c > new file mode 100644 > index 0000000..f93a1bf > --- /dev/null > +++ b/hw/z2.c > @@ -0,0 +1,358 @@ > +/* > + * PXA270-based Zipit Z2 device > + * > + * Copyright (c) 2011 by Vasily Khoruzhick <anars...@gmail.com> > + * > + * Code is based on mainstone platform. > + * > + * This code is licensed under the GNU GPL v2. > + */ > + > +#include "hw.h" > +#include "pxa.h" > +#include "arm-misc.h" > +#include "devices.h" > +#include "i2c.h" > +#include "ssi.h" > +#include "boards.h" > +#include "sysemu.h" > +#include "flash.h" > +#include "blockdev.h" > +#include "console.h" > +#include "audio/audio.h" > + > +#ifdef DEBUG_Z2 > +#define DPRINTF(fmt, ...) \ > + printf(fmt, ## __VA_ARGS__) > +#else > +#define DPRINTF(fmt, ...) > +#endif > + > +static struct keymap map[0x100] = { > + [0 ... 0xff] = { -1, -1 }, > + [0x3b] = {0, 0}, /* Option = F1 */ > + [0xc8] = {0, 1}, /* Up */ > + [0xd0] = {0, 2}, /* Down */ > + [0xcb] = {0, 3}, /* Left */ > + [0xcd] = {0, 4}, /* Right */ > + [0xcf] = {0, 5}, /* End */ > + [0x0d] = {0, 6}, /* KPPLUS */ > + [0xc7] = {1, 0}, /* Home */ > + [0x10] = {1, 1}, /* Q */ > + [0x17] = {1, 2}, /* I */ > + [0x22] = {1, 3}, /* G */ > + [0x2d] = {1, 4}, /* X */ > + [0x1c] = {1, 5}, /* Enter */ > + [0x0c] = {1, 6}, /* KPMINUS */ > + [0xc9] = {2, 0}, /* PageUp */ > + [0x11] = {2, 1}, /* W */ > + [0x18] = {2, 2}, /* O */ > + [0x23] = {2, 3}, /* H */ > + [0x2e] = {2, 4}, /* C */ > + [0x38] = {2, 5}, /* LeftAlt */ > + [0xd1] = {3, 0}, /* PageDown */ > + [0x12] = {3, 1}, /* E */ > + [0x19] = {3, 2}, /* P */ > + [0x24] = {3, 3}, /* J */ > + [0x2f] = {3, 4}, /* V */ > + [0x2a] = {3, 5}, /* LeftShift */ > + [0x01] = {4, 0}, /* Esc */ > + [0x13] = {4, 1}, /* R */ > + [0x1e] = {4, 2}, /* A */ > + [0x25] = {4, 3}, /* K */ > + [0x30] = {4, 4}, /* B */ > + [0x1d] = {4, 5}, /* LeftCtrl */ > + [0x0f] = {5, 0}, /* Tab */ > + [0x14] = {5, 1}, /* T */ > + [0x1f] = {5, 2}, /* S */ > + [0x26] = {5, 3}, /* L */ > + [0x31] = {5, 4}, /* N */ > + [0x39] = {5, 5}, /* Space */ > + [0x3c] = {6, 0}, /* Stop = F2 */ > + [0x15] = {6, 1}, /* Y */ > + [0x20] = {6, 2}, /* D */ > + [0x0e] = {6, 3}, /* Backspace */ > + [0x32] = {6, 4}, /* M */ > + [0x33] = {6, 5}, /* Comma */ > + [0x3d] = {7, 0}, /* Play = F3 */ > + [0x16] = {7, 1}, /* U */ > + [0x21] = {7, 2}, /* F */ > + [0x2c] = {7, 3}, /* Z */ > + [0x27] = {7, 4}, /* Semicolon */ > + [0x34] = {7, 5}, /* Dot */ > +}; > + > +#define Z2_RAM_SIZE 0x02000000 > +#define Z2_FLASH_BASE 0x00000000 > +#define Z2_FLASH_SIZE 0x00800000 > + > +static struct arm_boot_info z2_binfo = { > + .loader_start = PXA2XX_SDRAM_BASE, > + .ram_size = Z2_RAM_SIZE, > +}; > + > +#define Z2_GPIO_SD_DETECT 96 > +#define Z2_GPIO_AC_IN 0 > +#define Z2_GPIO_KEY_ON 1 > +#define Z2_GPIO_LCD_CS 88 > + > +typedef struct { > + SSISlave ssidev; > + int32_t selected; > + int32_t enabled; > + uint8_t buf[3]; > + uint32_t cur_reg; > + int pos; > +} ZipitLCD; > + > +static uint32_t zipit_lcd_transfer(SSISlave *dev, uint32_t value) > +{ > + ZipitLCD *z = FROM_SSI_SLAVE(ZipitLCD, dev); > + uint16_t val; > + if (z->selected) { > + z->buf[z->pos] = value & 0xff; > + z->pos++; > + } > + if (z->pos == 3) { > + switch (z->buf[0]) { > + case 0x74: > + DPRINTF("%s: reg: 0x%.2x\n", __func__, z->buf[2]); > + z->cur_reg = z->buf[2]; > + break; > + case 0x76: > + val = z->buf[1] << 8 | z->buf[2]; > + DPRINTF("%s: value: 0x%.4x\n", __func__, val); > + if (z->cur_reg == 0x22 && val == 0x0000) { > + z->enabled = 1; > + printf("%s: LCD enabled\n", __func__); > + } else if (z->cur_reg == 0x10 && val == 0x0000) { > + z->enabled = 0; > + printf("%s: LCD disabled\n", __func__); > + } > + break; > + default: > + DPRINTF("%s: unknown command!\n", __func__); > + break; > + } > + z->pos = 0; > + } > + return 0; > +} > + > +static void z2_lcd_cs(void *opaque, int line, int level) > +{ > + ZipitLCD *z2_lcd = opaque; > + z2_lcd->selected = !level; > +} > + > +static int zipit_lcd_init(SSISlave *dev) > +{ > + ZipitLCD *z = FROM_SSI_SLAVE(ZipitLCD, dev); > + z->selected = 0; > + z->enabled = 0; > + z->pos = 0; > + > + return 0; > +} > + > +static VMStateDescription vmstate_zipit_lcd_state = { > + .name = "zipit-lcd", > + .version_id = 1, > + .minimum_version_id = 1, > + .minimum_version_id_old = 1, > + .fields = (VMStateField[]) { > + VMSTATE_INT32(selected, ZipitLCD), > + VMSTATE_INT32(enabled, ZipitLCD), > + VMSTATE_BUFFER(buf, ZipitLCD), > + VMSTATE_UINT32(cur_reg, ZipitLCD), > + VMSTATE_INT32(pos, ZipitLCD), > + VMSTATE_END_OF_LIST(), > + } > +}; > + > +static SSISlaveInfo zipit_lcd_info = { > + .qdev.name = "zipit-lcd", > + .qdev.size = sizeof(ZipitLCD), > + .qdev.vmsd = &vmstate_zipit_lcd_state, > + .init = zipit_lcd_init, > + .transfer = zipit_lcd_transfer > +}; > + > +typedef struct { > + i2c_slave i2c; > + int len; > + uint8_t buf[3]; > +} AER915State; > + > +static int aer915_send(i2c_slave *i2c, uint8_t data) > +{ > + AER915State *s = FROM_I2C_SLAVE(AER915State, i2c); > + s->buf[s->len] = data; > + if (s->len++ > 2) { > + DPRINTF("%s: message too long (%i bytes)\n", > + __func__, s->len); > + return 1; > + } > + > + if (s->len == 2) { > + DPRINTF("%s: reg %d value 0x%02x\n", __func__, > + s->buf[0], s->buf[1]); > + } > + > + return 0; > +} > + > +static void aer915_event(i2c_slave *i2c, enum i2c_event event) > +{ > + AER915State *s = FROM_I2C_SLAVE(AER915State, i2c); > + switch (event) { > + case I2C_START_SEND: > + s->len = 0; > + break; > + case I2C_START_RECV: > + if (s->len != 1) { > + DPRINTF("%s: short message!?\n", __func__); > + } > + break; > + case I2C_FINISH: > + break; > + default: > + break; > + } > +} > + > +static int aer915_recv(i2c_slave *slave) > +{ > + int retval = 0x00; > + AER915State *s = FROM_I2C_SLAVE(AER915State, slave); > + > + switch (s->buf[0]) { > + /* Return hardcoded battery voltage, > + * 0xf0 means ~4.1V > + */ > + case 0x02: > + retval = 0xf0; > + break; > + /* Return 0x00 for other regs, > + * we don't know what they are for, > + * anyway they return 0x00 on real hardware. > + */ > + default: > + break; > + } > + > + return retval; > +} > + > +static int aer915_init(i2c_slave *i2c) > +{ > + /* Nothing to do. */ > + return 0; > +} > + > +static VMStateDescription vmstate_aer915_state = { > + .name = "aer915", > + .version_id = 1, > + .minimum_version_id = 1, > + .minimum_version_id_old = 1, > + .fields = (VMStateField[]) { > + VMSTATE_INT32(len, AER915State), > + VMSTATE_BUFFER(buf, AER915State), > + VMSTATE_END_OF_LIST(), > + } > +}; > + > +static I2CSlaveInfo aer915_info = { > + .qdev.name = "aer915", > + .qdev.size = sizeof(AER915State), > + .qdev.vmsd = &vmstate_aer915_state, > + .init = aer915_init, > + .event = aer915_event, > + .recv = aer915_recv, > + .send = aer915_send > +}; > + > +static void z2_init(ram_addr_t ram_size, > + const char *boot_device, > + const char *kernel_filename, const char *kernel_cmdline, > + const char *initrd_filename, const char *cpu_model) > +{ > + uint32_t sector_len = 0x10000; > + PXA2xxState *cpu; > + DriveInfo *dinfo; > + int be; > + void *z2_lcd; > + i2c_bus *bus; > + DeviceState *wm; > + > + if (!cpu_model) { > + cpu_model = "pxa270-c5"; > + } > + > + /* Setup CPU & memory */ > + cpu = pxa270_init(z2_binfo.ram_size, cpu_model); > + > +#ifdef TARGET_WORDS_BIGENDIAN > + be = 1; > +#else > + be = 0; > +#endif > + dinfo = drive_get(IF_PFLASH, 0, 0); > + if (!dinfo) { > + fprintf(stderr, "Flash image must be given with the " > + "'pflash' parameter\n"); > + exit(1); > + } > + > + if (!pflash_cfi01_register(Z2_FLASH_BASE, > + qemu_ram_alloc(NULL, "z2.flash0", > Z2_FLASH_SIZE), + dinfo->bdrv, sector_len, > + Z2_FLASH_SIZE / sector_len, 4, 0, 0, 0, 0, > + be)) { > + fprintf(stderr, "qemu: Error registering flash memory.\n"); > + exit(1); > + } > + > + /* setup keypad */ > + pxa27x_register_keypad(cpu->kp, map, 0x100); > + > + /* MMC/SD host */ > + pxa2xx_mmci_handlers(cpu->mmc, > + NULL, > + qdev_get_gpio_in(cpu->gpio, Z2_GPIO_SD_DETECT)); > + > + ssi_register_slave(&zipit_lcd_info); > + i2c_register_slave(&aer915_info); > + z2_lcd = ssi_create_slave(cpu->ssp[1], "zipit-lcd"); > + bus = pxa2xx_i2c_bus(cpu->i2c[0]); > + i2c_create_slave(bus, "aer915", 0x55); > + wm = i2c_create_slave(bus, "wm8750", 0x1b); > + cpu->i2s->opaque = wm; > + cpu->i2s->codec_out = wm8750_dac_dat; > + cpu->i2s->codec_in = wm8750_adc_dat; > + wm8750_data_req_set(wm, cpu->i2s->data_req, cpu->i2s); > + > + qdev_connect_gpio_out(cpu->gpio, Z2_GPIO_LCD_CS, > + qemu_allocate_irqs(z2_lcd_cs, z2_lcd, 1)[0]); > + > + if (kernel_filename) { > + z2_binfo.kernel_filename = kernel_filename; > + z2_binfo.kernel_cmdline = kernel_cmdline; > + z2_binfo.initrd_filename = initrd_filename; > + z2_binfo.board_id = 0x6dd; > + arm_load_kernel(cpu->env, &z2_binfo); > + } > +} > + > +static QEMUMachine z2_machine = { > + .name = "z2", > + .desc = "Zipit Z2 (PXA27x)", > + .init = z2_init, > +}; > + > +static void z2_machine_init(void) > +{ > + qemu_register_machine(&z2_machine); > +} > + > +machine_init(z2_machine_init);