From f040ec232fc29df8e3e5e5425ad7c92160832285 Mon Sep 17 00:00:00 2001 From: Lars-Peter Clausen Date: Wed, 3 Feb 2010 16:21:08 +0100 Subject: [PATCH] foobar --- usbboot/src/mem.c | 61 ++++++++++++++++++++++ usbboot/src/mem.h | 13 +++++ usbboot/src/server.c | 120 +++++++++++++++++++++++++++++++++++++++++++ 3 files changed, 194 insertions(+) create mode 100644 usbboot/src/mem.c create mode 100644 usbboot/src/mem.h create mode 100644 usbboot/src/server.c diff --git a/usbboot/src/mem.c b/usbboot/src/mem.c new file mode 100644 index 0000000..383d9a4 --- /dev/null +++ b/usbboot/src/mem.c @@ -0,0 +1,61 @@ +#include +#include +#include "ingenic_usb.h" + +#define MEM_WRITE 0 +#define MEM_READ 1 + +#define MEM_8BIT (0 << 1) +#define MEM_16BIT (1 << 1) +#define MEM_32BIT (2 << 1) + +static void mem_write(struct ingenic_dev *dev, uint32_t addr, uint32_t val, unsigned int width) +{ + char ret[8]; + usb_send_data_address_to_ingenic(dev, addr); + usb_send_data_length_to_ingenic(dev, val); + usb_ingenic_mem_ops(dev, MEM_WRITE | width); + usb_read_data_from_ingenic(dev, ret, ARRAY_SIZE(ret)); +} + +static uint32_t mem_read(struct ingenic_dev *dev, uint32_t addr, unsigned int width) +{ + char ret[8]; + usb_send_data_address_to_ingenic(dev, addr); + usb_ingenic_mem_ops(dev, MEM_READ | width); + usb_read_data_from_ingenic(dev, ret, ARRAY_SIZE(ret)); + + return (((unsigned char)ret[3]) << 24) | (((unsigned char)ret[2]) << 16) | + (((unsigned char)ret[1]) << 8) | ((unsigned char)ret[0]); +} + +void mem_write8(struct ingenic_dev *dev, uint32_t addr, uint8_t val) +{ + mem_write(dev, addr, val, MEM_8BIT); +} + +void mem_write16(struct ingenic_dev *dev, uint32_t addr, uint16_t val) +{ + mem_write(dev, addr, val, MEM_16BIT); +} + +void mem_write32(struct ingenic_dev *dev, uint32_t addr, uint32_t val) +{ + mem_write(dev, addr, val, MEM_32BIT); +} + +uint8_t mem_read8(struct ingenic_dev *dev, uint32_t addr) +{ + uint8_t val = mem_read(dev, addr, MEM_8BIT) & 0xff; + return val; +} + +uint16_t mem_read16(struct ingenic_dev *dev, uint32_t addr) +{ + return mem_read(dev, addr, MEM_16BIT) & 0xffff; +} + +uint32_t mem_read32(struct ingenic_dev *dev, uint32_t addr) +{ + return mem_read(dev, addr, MEM_32BIT); +} diff --git a/usbboot/src/mem.h b/usbboot/src/mem.h new file mode 100644 index 0000000..0240aa4 --- /dev/null +++ b/usbboot/src/mem.h @@ -0,0 +1,13 @@ +#ifndef __MEM_H +#define __MEM_H + +struct ingenic_dev; + +void mem_write32(struct ingenic_dev *dev, uint32_t addr, uint32_t val); +void mem_write16(struct ingenic_dev *dev, uint32_t addr, uint16_t val); +void mem_write8(struct ingenic_dev *dev, uint32_t addr, uint8_t val); +uint32_t mem_read32(struct ingenic_dev *dev, uint32_t addr); +uint16_t mem_read16(struct ingenic_dev *dev, uint32_t addr); +uint8_t mem_read8(struct ingenic_dev *dev, uint32_t addr); + +#endif diff --git a/usbboot/src/server.c b/usbboot/src/server.c new file mode 100644 index 0000000..36a3543 --- /dev/null +++ b/usbboot/src/server.c @@ -0,0 +1,120 @@ +#include +#include +#include +#include +#include +#include +#include +#include + +#include "mem.h" +#include "cmd.h" +#include "ingenic_usb.h" +#include "ingenic_cfg.h" + +#define PORT 1338 + +#define TYPE_READ8 0 +#define TYPE_READ16 1 +#define TYPE_READ32 2 +#define TYPE_WRITE8 3 +#define TYPE_WRITE16 4 +#define TYPE_WRITE32 5 + +struct request { + uint32_t addr; + uint32_t value; + uint8_t type; +}; + +struct response { + uint32_t value; +}; + +#define CONFIG_FILE_PATH "/etc/xburst-tools/usbboot.cfg" + +struct ingenic_dev ingenic_dev; + +int main(int argc, char *argv[]) +{ + int s, t; + unsigned int sinlen; + struct sockaddr_in sin; + struct request request; + struct response response; + char *cfgpath = CONFIG_FILE_PATH; + + if (usb_ingenic_init(&ingenic_dev)) + return EXIT_FAILURE; + + if (parse_configure(&ingenic_dev.config, cfgpath)) + return EXIT_FAILURE; + + boot(&ingenic_dev, STAGE1_FILE_PATH, STAGE2_FILE_PATH); + + if ( (s = socket(AF_INET, SOCK_STREAM, 0 ) ) < 0) { + return -1; + } + + sin.sin_family = AF_INET; /*set protocol family to Internet */ + sin.sin_port = htons(PORT); /* set port no. */ + sin.sin_addr.s_addr = INADDR_ANY; /* set IP addr to any interface */ + + if (bind(s, (struct sockaddr *)&sin, sizeof(sin) ) < 0 ){ + perror("bind"); return -1; /* bind error */ + } + + /* server indicates it's ready, max. listen queue is 5 */ + if (listen(s, 5)) { + return -1; + } + + sinlen = sizeof(sin); + if ( (t = accept(s, (struct sockaddr *) &sin, &sinlen) ) < 0 ){ + perror("accept "); /* accpet error */ + return -1; + } + + while (1) { + + if (recv(t, (char*)&request, sizeof(request), 0) < 0) { + perror("recv"); + return -1; + } + +/* printf("Got request %x %x %x\n", request.type, request.addr, + request.value);*/ + + switch (request.type) { + case TYPE_READ8: + response.value = mem_read8(&ingenic_dev, request.addr); + break; + case TYPE_READ16: + response.value = mem_read16(&ingenic_dev, request.addr); + break; + case TYPE_READ32: + response.value = mem_read32(&ingenic_dev, request.addr); + break; + case TYPE_WRITE8: + mem_write8(&ingenic_dev, request.addr, request.value); + break; + case TYPE_WRITE16: + mem_write16(&ingenic_dev, request.addr, request.value); + break; + case TYPE_WRITE32: + mem_write32(&ingenic_dev, request.addr, request.value); + break; + } +/* printf("Got response %x\n", response.value);*/ + + if (send(t, (char*)&response, sizeof(response),0 ) < 0 ) { + perror("send"); + return -1; + } + } + + close(t); + close(s); + + return 0; +}