Fix coding style of flashrom by running indent on all files:
indent -npro -kr -i8 -ts8 -sob -l80 -ss -ncs *.[ch] Some minor fixups were required, and maybe a few more cosmetic changeѕ are needed. Signed-off-by: Uwe Hermann <uwe@hermann-uwe.de> Acked-by: Uwe Hermann <uwe@hermann-uwe.de> git-svn-id: svn://svn.coreboot.org/coreboot/trunk@2643 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1
This commit is contained in:
parent
33d1af37ae
commit
c7dc7cc196
|
@ -52,9 +52,9 @@ int probe_82802ab(struct flashchip *flash)
|
|||
uint8_t id1, id2;
|
||||
|
||||
#if 0
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0x90;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0x90;
|
||||
#endif
|
||||
|
||||
*bios = 0xff;
|
||||
|
@ -62,13 +62,13 @@ int probe_82802ab(struct flashchip *flash)
|
|||
*bios = 0x90;
|
||||
myusec_delay(10);
|
||||
|
||||
id1 = *(volatile uint8_t *) bios;
|
||||
id2 = *(volatile uint8_t *) (bios + 0x01);
|
||||
id1 = *(volatile uint8_t *)bios;
|
||||
id2 = *(volatile uint8_t *)(bios + 0x01);
|
||||
|
||||
#if 1
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xF0;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xF0;
|
||||
|
||||
#endif
|
||||
myusec_delay(10);
|
||||
|
@ -82,7 +82,7 @@ int probe_82802ab(struct flashchip *flash)
|
|||
fd_mem, (off_t) (0 - 0x400000 - size));
|
||||
if (bios == MAP_FAILED) {
|
||||
// it's this part but we can't map it ...
|
||||
perror("Error MMAP memory using " MEM_DEV );
|
||||
perror("Error MMAP memory using " MEM_DEV);
|
||||
exit(1);
|
||||
}
|
||||
|
||||
|
@ -101,7 +101,7 @@ uint8_t wait_82802ab(volatile uint8_t *bios)
|
|||
|
||||
*bios = 0x70;
|
||||
if ((*bios & 0x80) == 0) { // it's busy
|
||||
while ((*bios & 0x80) == 0);
|
||||
while ((*bios & 0x80) == 0) ;
|
||||
}
|
||||
|
||||
status = *bios;
|
||||
|
@ -111,21 +111,20 @@ uint8_t wait_82802ab(volatile uint8_t *bios)
|
|||
*bios = 0x90;
|
||||
myusec_delay(10);
|
||||
|
||||
id1 = *(volatile uint8_t *) bios;
|
||||
id2 = *(volatile uint8_t *) (bios + 0x01);
|
||||
id1 = *(volatile uint8_t *)bios;
|
||||
id2 = *(volatile uint8_t *)(bios + 0x01);
|
||||
|
||||
// this is needed to jam it out of "read id" mode
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xF0;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xF0;
|
||||
return status;
|
||||
|
||||
}
|
||||
int erase_82802ab_block(struct flashchip *flash, int offset)
|
||||
{
|
||||
volatile uint8_t *bios = flash->virt_addr + offset;
|
||||
volatile uint8_t *wrprotect =
|
||||
flash->virt_addr_2 + offset + 2;
|
||||
volatile uint8_t *wrprotect = flash->virt_addr_2 + offset + 2;
|
||||
uint8_t status;
|
||||
|
||||
// clear status register
|
||||
|
@ -138,8 +137,8 @@ int erase_82802ab_block(struct flashchip *flash, int offset)
|
|||
//printf("write protect is 0x%x\n", *(wrprotect));
|
||||
|
||||
// now start it
|
||||
*(volatile uint8_t *) (bios) = 0x20;
|
||||
*(volatile uint8_t *) (bios) = 0xd0;
|
||||
*(volatile uint8_t *)(bios) = 0x20;
|
||||
*(volatile uint8_t *)(bios) = 0xd0;
|
||||
myusec_delay(10);
|
||||
// now let's see what the register is
|
||||
status = wait_82802ab(flash->virt_addr);
|
||||
|
@ -160,8 +159,8 @@ int erase_82802ab(struct flashchip *flash)
|
|||
return (0);
|
||||
}
|
||||
|
||||
void write_page_82802ab(volatile uint8_t *bios, uint8_t *src, volatile uint8_t *dst,
|
||||
int page_size)
|
||||
void write_page_82802ab(volatile uint8_t *bios, uint8_t *src,
|
||||
volatile uint8_t *dst, int page_size)
|
||||
{
|
||||
int i;
|
||||
|
||||
|
@ -177,8 +176,8 @@ void write_page_82802ab(volatile uint8_t *bios, uint8_t *src, volatile uint8_t *
|
|||
int write_82802ab(struct flashchip *flash, uint8_t *buf)
|
||||
{
|
||||
int i;
|
||||
int total_size = flash->total_size * 1024, page_size =
|
||||
flash->page_size;
|
||||
int total_size = flash->total_size * 1024;
|
||||
int page_size = flash->page_size;
|
||||
volatile uint8_t *bios = flash->virt_addr;
|
||||
|
||||
erase_82802ab(flash);
|
||||
|
@ -191,8 +190,7 @@ int write_82802ab(struct flashchip *flash, uint8_t *buf)
|
|||
printf("%04d at address: 0x%08x", i, i * page_size);
|
||||
write_page_82802ab(bios, buf + i * page_size,
|
||||
bios + i * page_size, page_size);
|
||||
printf
|
||||
("\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b");
|
||||
printf("\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b");
|
||||
}
|
||||
printf("\n");
|
||||
protect_82802ab(bios);
|
||||
|
|
|
@ -30,38 +30,33 @@
|
|||
#define W836_DATA 0x2F
|
||||
|
||||
/* Enter extended functions */
|
||||
static void
|
||||
w836xx_ext_enter(void)
|
||||
static void w836xx_ext_enter(void)
|
||||
{
|
||||
outb(0x87, W836_INDEX);
|
||||
outb(0x87, W836_INDEX);
|
||||
}
|
||||
|
||||
/* Leave extended functions */
|
||||
static void
|
||||
w836xx_ext_leave(void)
|
||||
static void w836xx_ext_leave(void)
|
||||
{
|
||||
outb(0xAA, W836_INDEX);
|
||||
}
|
||||
|
||||
/* General functions for read/writing WB SuperIOs */
|
||||
static unsigned char
|
||||
wbsio_read(unsigned char index)
|
||||
static unsigned char wbsio_read(unsigned char index)
|
||||
{
|
||||
outb(index, W836_INDEX);
|
||||
return inb(W836_DATA);
|
||||
}
|
||||
|
||||
static void
|
||||
wbsio_write(unsigned char index, unsigned char data)
|
||||
static void wbsio_write(unsigned char index, unsigned char data)
|
||||
{
|
||||
outb(index, W836_INDEX);
|
||||
outb(data, W836_DATA);
|
||||
}
|
||||
|
||||
static void
|
||||
wbsio_mask(unsigned char index, unsigned char data,
|
||||
unsigned char mask)
|
||||
wbsio_mask(unsigned char index, unsigned char data, unsigned char mask)
|
||||
{
|
||||
unsigned char tmp;
|
||||
|
||||
|
@ -204,20 +199,20 @@ struct board_pciid_enable {
|
|||
char *lb_part;
|
||||
|
||||
char *name;
|
||||
int (*enable)(const char *name);
|
||||
int (*enable) (const char *name);
|
||||
};
|
||||
|
||||
struct board_pciid_enable board_pciid_enables[] = {
|
||||
{ 0x1022, 0x7468, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
||||
"iwill", "dk8_htx", "IWILL DK8-HTX", w83627hf_gpio24_raise },
|
||||
{ 0x1022, 0x746B, 0x1022, 0x36C0, 0x0000, 0x0000, 0x0000, 0x0000,
|
||||
"AGAMI", "ARUMA", "agami Aruma", w83627hf_gpio24_raise },
|
||||
{ 0x1106, 0x3177, 0x1106, 0xAA01, 0x1106, 0x3123, 0x1106, 0xAA01,
|
||||
NULL, NULL, "VIA EPIA M/MII/...", board_via_epia_m },
|
||||
{ 0x1106, 0x3177, 0x1043, 0x80A1, 0x1106, 0x3205, 0x1043, 0x8118,
|
||||
NULL, NULL, "ASUS A7V8-MX SE", board_asus_a7v8x_mx },
|
||||
{0x1022, 0x7468, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
||||
"iwill", "dk8_htx", "IWILL DK8-HTX", w83627hf_gpio24_raise},
|
||||
{0x1022, 0x746B, 0x1022, 0x36C0, 0x0000, 0x0000, 0x0000, 0x0000,
|
||||
"AGAMI", "ARUMA", "agami Aruma", w83627hf_gpio24_raise},
|
||||
{0x1106, 0x3177, 0x1106, 0xAA01, 0x1106, 0x3123, 0x1106, 0xAA01,
|
||||
NULL, NULL, "VIA EPIA M/MII/...", board_via_epia_m},
|
||||
{0x1106, 0x3177, 0x1043, 0x80A1, 0x1106, 0x3205, 0x1043, 0x8118,
|
||||
NULL, NULL, "ASUS A7V8-MX SE", board_asus_a7v8x_mx},
|
||||
|
||||
{ 0, 0, 0, 0, 0, 0, 0, 0, NULL, NULL } /* Keep this */
|
||||
{0, 0, 0, 0, 0, 0, 0, 0, NULL, NULL} /* Keep this */
|
||||
};
|
||||
|
||||
/*
|
||||
|
@ -225,8 +220,8 @@ struct board_pciid_enable board_pciid_enables[] = {
|
|||
* Require main pci-ids to match too as extra safety.
|
||||
*
|
||||
*/
|
||||
static struct board_pciid_enable *
|
||||
board_match_linuxbios_name(char *vendor, char *part)
|
||||
static struct board_pciid_enable *board_match_linuxbios_name(char *vendor,
|
||||
char *part)
|
||||
{
|
||||
struct board_pciid_enable *board = board_pciid_enables;
|
||||
|
||||
|
|
|
@ -80,15 +80,16 @@ static int enable_flash_piix4(struct pci_dev *dev, char *name)
|
|||
old = pci_read_word(dev, xbcs);
|
||||
|
||||
/* Set bit 9: 1-Meg Extended BIOS Enable (PCI master accesses to
|
||||
FFF00000-FFF7FFFF are forwarded to ISA).
|
||||
Set bit 7: Extended BIOS Enable (PCI master accesses to
|
||||
FFF80000-FFFDFFFF are forwarded to ISA).
|
||||
Set bit 6: Lower BIOS Enable (PCI master, or ISA master accesses to
|
||||
the lower 64-Kbyte BIOS block (E0000-EFFFF) at the top
|
||||
of 1 Mbyte, or the aliases at the top of 4 Gbyte
|
||||
(FFFE0000-FFFEFFFF) result in the generation of BIOSCS#.
|
||||
Note: Accesses to FFFF0000-FFFFFFFF are always forwarded to ISA.
|
||||
Set bit 2: BIOSCS# Write Enable (1=enable, 0=disable). */
|
||||
* FFF00000-FFF7FFFF are forwarded to ISA).
|
||||
* Set bit 7: Extended BIOS Enable (PCI master accesses to
|
||||
* FFF80000-FFFDFFFF are forwarded to ISA).
|
||||
* Set bit 6: Lower BIOS Enable (PCI master, or ISA master accesses to
|
||||
* the lower 64-Kbyte BIOS block (E0000-EFFFF) at the top
|
||||
* of 1 Mbyte, or the aliases at the top of 4 Gbyte
|
||||
* (FFFE0000-FFFEFFFF) result in the generation of BIOSCS#.
|
||||
* Note: Accesses to FFFF0000-FFFFFFFF are always forwarded to ISA.
|
||||
* Set bit 2: BIOSCS# Write Enable (1=enable, 0=disable).
|
||||
*/
|
||||
new = old | 0x2c4;
|
||||
|
||||
if (new == old)
|
||||
|
@ -130,8 +131,7 @@ static int enable_flash_ich(struct pci_dev *dev, char *name, int bios_cntl)
|
|||
pci_write_byte(dev, bios_cntl, new);
|
||||
|
||||
if (pci_read_byte(dev, bios_cntl) != new) {
|
||||
printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n",
|
||||
bios_cntl, new, name);
|
||||
printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n", bios_cntl, new, name);
|
||||
return -1;
|
||||
}
|
||||
return 0;
|
||||
|
@ -150,8 +150,7 @@ static int enable_flash_ich_dc(struct pci_dev *dev, char *name)
|
|||
/*
|
||||
*
|
||||
*/
|
||||
static int
|
||||
enable_flash_vt823x(struct pci_dev *dev, char *name)
|
||||
static int enable_flash_vt823x(struct pci_dev *dev, char *name)
|
||||
{
|
||||
uint8_t val;
|
||||
|
||||
|
@ -178,8 +177,7 @@ static int enable_flash_cs5530(struct pci_dev *dev, char *name)
|
|||
new = pci_read_byte(dev, 0x52);
|
||||
|
||||
if (new != 0xee) {
|
||||
printf("tried to set register 0x%x to 0x%x on %s failed (WARNING ONLY)\n",
|
||||
0x52, new, name);
|
||||
printf("tried to set register 0x%x to 0x%x on %s failed (WARNING ONLY)\n", 0x52, new, name);
|
||||
return -1;
|
||||
}
|
||||
|
||||
|
@ -189,7 +187,6 @@ static int enable_flash_cs5530(struct pci_dev *dev, char *name)
|
|||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static int enable_flash_sc1100(struct pci_dev *dev, char *name)
|
||||
{
|
||||
uint8_t new;
|
||||
|
@ -199,8 +196,7 @@ static int enable_flash_sc1100(struct pci_dev *dev, char *name)
|
|||
new = pci_read_byte(dev, 0x52);
|
||||
|
||||
if (new != 0xee) {
|
||||
printf("tried to set register 0x%x to 0x%x on %s failed (WARNING ONLY)\n",
|
||||
0x52, new, name);
|
||||
printf("tried to set register 0x%x to 0x%x on %s failed (WARNING ONLY)\n", 0x52, new, name);
|
||||
return -1;
|
||||
}
|
||||
return 0;
|
||||
|
@ -221,8 +217,7 @@ static int enable_flash_sis5595(struct pci_dev *dev, char *name)
|
|||
|
||||
newer = pci_read_byte(dev, 0x45);
|
||||
if (newer != new) {
|
||||
printf("tried to set register 0x%x to 0x%x on %s failed (WARNING ONLY)\n",
|
||||
0x45, new, name);
|
||||
printf("tried to set register 0x%x to 0x%x on %s failed (WARNING ONLY)\n", 0x45, new, name);
|
||||
printf("Stuck at 0x%x\n", newer);
|
||||
return -1;
|
||||
}
|
||||
|
@ -233,6 +228,7 @@ static int enable_flash_amd8111(struct pci_dev *dev, char *name)
|
|||
{
|
||||
/* register 4e.b gets or'ed with one */
|
||||
uint8_t old, new;
|
||||
|
||||
/* if it fails, it fails. There are so many variations of broken mobos
|
||||
* that it is hard to argue that we should quit at this point.
|
||||
*/
|
||||
|
@ -243,8 +239,7 @@ static int enable_flash_amd8111(struct pci_dev *dev, char *name)
|
|||
if (new != old) {
|
||||
pci_write_byte(dev, 0x43, new);
|
||||
if (pci_read_byte(dev, 0x43) != new) {
|
||||
printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n",
|
||||
0x43, new, name);
|
||||
printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n", 0x43, new, name);
|
||||
}
|
||||
}
|
||||
|
||||
|
@ -255,8 +250,7 @@ static int enable_flash_amd8111(struct pci_dev *dev, char *name)
|
|||
pci_write_byte(dev, 0x40, new);
|
||||
|
||||
if (pci_read_byte(dev, 0x40) != new) {
|
||||
printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n",
|
||||
0x40, new, name);
|
||||
printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n", 0x40, new, name);
|
||||
return -1;
|
||||
}
|
||||
return 0;
|
||||
|
@ -266,6 +260,7 @@ static int enable_flash_ck804(struct pci_dev *dev, char *name)
|
|||
{
|
||||
/* register 4e.b gets or'ed with one */
|
||||
uint8_t old, new;
|
||||
|
||||
/* if it fails, it fails. There are so many variations of broken mobos
|
||||
* that it is hard to argue that we should quit at this point.
|
||||
*/
|
||||
|
@ -277,8 +272,7 @@ static int enable_flash_ck804(struct pci_dev *dev, char *name)
|
|||
if (new != old) {
|
||||
pci_write_byte(dev, 0x88, new);
|
||||
if (pci_read_byte(dev, 0x88) != new) {
|
||||
printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n",
|
||||
0x88, new, name);
|
||||
printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n", 0x88, new, name);
|
||||
}
|
||||
}
|
||||
|
||||
|
@ -289,8 +283,7 @@ static int enable_flash_ck804(struct pci_dev *dev, char *name)
|
|||
pci_write_byte(dev, 0x6d, new);
|
||||
|
||||
if (pci_read_byte(dev, 0x6d) != new) {
|
||||
printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n",
|
||||
0x6d, new, name);
|
||||
printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n", 0x6d, new, name);
|
||||
return -1;
|
||||
}
|
||||
return 0;
|
||||
|
@ -304,7 +297,7 @@ static int enable_flash_sb400(struct pci_dev *dev, char *name)
|
|||
struct pci_dev *smbusdev;
|
||||
|
||||
/* then look for the smbus device */
|
||||
pci_filter_init((struct pci_access *) 0, &f);
|
||||
pci_filter_init((struct pci_access *)0, &f);
|
||||
f.vendor = 0x1002;
|
||||
f.device = 0x4372;
|
||||
|
||||
|
@ -314,26 +307,26 @@ static int enable_flash_sb400(struct pci_dev *dev, char *name)
|
|||
}
|
||||
}
|
||||
|
||||
if(!smbusdev) {
|
||||
if (!smbusdev) {
|
||||
fprintf(stderr, "ERROR: SMBus device not found. aborting\n");
|
||||
exit(1);
|
||||
}
|
||||
|
||||
/* enable some smbus stuff */
|
||||
tmp=pci_read_byte(smbusdev, 0x79);
|
||||
tmp|=0x01;
|
||||
tmp = pci_read_byte(smbusdev, 0x79);
|
||||
tmp |= 0x01;
|
||||
pci_write_byte(smbusdev, 0x79, tmp);
|
||||
|
||||
/* change southbridge */
|
||||
tmp=pci_read_byte(dev, 0x48);
|
||||
tmp|=0x21;
|
||||
tmp = pci_read_byte(dev, 0x48);
|
||||
tmp |= 0x21;
|
||||
pci_write_byte(dev, 0x48, tmp);
|
||||
|
||||
/* now become a bit silly. */
|
||||
tmp=inb(0xc6f);
|
||||
outb(tmp,0xeb);
|
||||
tmp = inb(0xc6f);
|
||||
outb(tmp, 0xeb);
|
||||
tmp|=0x40;
|
||||
outb(tmp, 0xeb);
|
||||
tmp |= 0x40;
|
||||
outb(tmp, 0xc6f);
|
||||
outb(tmp, 0xeb);
|
||||
outb(tmp, 0xeb);
|
||||
|
@ -371,7 +364,8 @@ static int enable_flash_mcp55(struct pci_dev *dev, char *name)
|
|||
pci_write_byte(dev, 0x6d, new);
|
||||
|
||||
if (pci_read_byte(dev, 0x6d) != new) {
|
||||
printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n",
|
||||
printf
|
||||
("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n",
|
||||
0x6d, new, name);
|
||||
return -1;
|
||||
}
|
||||
|
@ -410,7 +404,7 @@ static FLASH_ENABLE enables[] = {
|
|||
{0x1106, 0x8231, "VT8231", enable_flash_vt823x},
|
||||
{0x1106, 0x3177, "VT8235", enable_flash_vt823x},
|
||||
{0x1106, 0x3227, "VT8237", enable_flash_vt823x},
|
||||
{0x1106, 0x8324, "CX700" , enable_flash_vt823x},
|
||||
{0x1106, 0x8324, "CX700", enable_flash_vt823x},
|
||||
{0x1106, 0x0686, "VT82C686", enable_flash_amd8111},
|
||||
{0x1078, 0x0100, "CS5530", enable_flash_cs5530},
|
||||
{0x100b, 0x0510, "SC1100", enable_flash_sc1100},
|
||||
|
@ -441,8 +435,7 @@ static FLASH_ENABLE enables[] = {
|
|||
/*
|
||||
*
|
||||
*/
|
||||
int
|
||||
chipset_flash_enable(void)
|
||||
int chipset_flash_enable(void)
|
||||
{
|
||||
struct pci_dev *dev = 0;
|
||||
int ret = -2; /* nothing! */
|
||||
|
|
|
@ -53,15 +53,14 @@
|
|||
char *chip_to_probe = NULL;
|
||||
struct pci_access *pacc; /* For board and chipset_enable */
|
||||
int exclude_start_page, exclude_end_page;
|
||||
int force=0, verbose=0;
|
||||
int force = 0, verbose = 0;
|
||||
|
||||
int fd_mem;
|
||||
|
||||
/*
|
||||
*
|
||||
*/
|
||||
struct pci_dev *
|
||||
pci_dev_find(uint16_t vendor, uint16_t device)
|
||||
struct pci_dev *pci_dev_find(uint16_t vendor, uint16_t device)
|
||||
{
|
||||
struct pci_dev *temp;
|
||||
struct pci_filter filter;
|
||||
|
@ -80,8 +79,7 @@ pci_dev_find(uint16_t vendor, uint16_t device)
|
|||
/*
|
||||
*
|
||||
*/
|
||||
struct pci_dev *
|
||||
pci_card_find(uint16_t vendor, uint16_t device,
|
||||
struct pci_dev *pci_card_find(uint16_t vendor, uint16_t device,
|
||||
uint16_t card_vendor, uint16_t card_device)
|
||||
{
|
||||
struct pci_dev *temp;
|
||||
|
@ -132,11 +130,11 @@ struct flashchip *probe_flash(struct flashchip *flash)
|
|||
if (getpagesize() > size) {
|
||||
size = getpagesize();
|
||||
printf("WARNING: size: %d -> %ld (page size)\n",
|
||||
flash->total_size * 1024, (unsigned long) size);
|
||||
flash->total_size * 1024, (unsigned long)size);
|
||||
}
|
||||
|
||||
bios = mmap(0, size, PROT_WRITE | PROT_READ, MAP_SHARED,
|
||||
fd_mem, (off_t)flash_baseaddr );
|
||||
fd_mem, (off_t) flash_baseaddr);
|
||||
if (bios == MAP_FAILED) {
|
||||
perror("Error: Can't mmap " MEM_DEV ".");
|
||||
exit(1);
|
||||
|
@ -148,7 +146,7 @@ struct flashchip *probe_flash(struct flashchip *flash)
|
|||
flash->name, flash_baseaddr);
|
||||
return flash;
|
||||
}
|
||||
munmap((void *) bios, size);
|
||||
munmap((void *)bios, size);
|
||||
|
||||
flash++;
|
||||
}
|
||||
|
@ -163,10 +161,11 @@ int verify_flash(struct flashchip *flash, uint8_t *buf)
|
|||
|
||||
printf("Verifying flash ");
|
||||
|
||||
if(verbose) printf("address: 0x00000000\b\b\b\b\b\b\b\b\b\b");
|
||||
if (verbose)
|
||||
printf("address: 0x00000000\b\b\b\b\b\b\b\b\b\b");
|
||||
|
||||
for (idx = 0; idx < total_size; idx++) {
|
||||
if (verbose && ( (idx & 0xfff) == 0xfff ))
|
||||
if (verbose && ((idx & 0xfff) == 0xfff))
|
||||
printf("0x%08x", idx);
|
||||
|
||||
if (*(bios + idx) != *(buf + idx)) {
|
||||
|
@ -177,7 +176,7 @@ int verify_flash(struct flashchip *flash, uint8_t *buf)
|
|||
return 1;
|
||||
}
|
||||
|
||||
if (verbose && ( (idx & 0xfff) == 0xfff ))
|
||||
if (verbose && ((idx & 0xfff) == 0xfff))
|
||||
printf("\b\b\b\b\b\b\b\b\b\b");
|
||||
}
|
||||
if (verbose)
|
||||
|
@ -187,12 +186,12 @@ int verify_flash(struct flashchip *flash, uint8_t *buf)
|
|||
return 0;
|
||||
}
|
||||
|
||||
|
||||
void usage(const char *name)
|
||||
{
|
||||
printf("usage: %s [-rwvEVfh] [-c chipname] [-s exclude_start]\n", name);
|
||||
printf(" [-e exclude_end] [-m vendor:part] [-l file.layout] [-i imagename] [file]\n");
|
||||
printf(" -r | --read: read flash and save into file\n"
|
||||
printf
|
||||
(" -r | --read: read flash and save into file\n"
|
||||
" -w | --write: write file into flash (default when\n"
|
||||
" file is specified)\n"
|
||||
" -v | --verify: verify flash against file\n"
|
||||
|
@ -205,8 +204,7 @@ void usage(const char *name)
|
|||
" -f | --force: force write without checking image\n"
|
||||
" -l | --layout <file.layout>: read rom layout from file\n"
|
||||
" -i | --image <name>: only flash image name from flash layout\n"
|
||||
"\n"
|
||||
" If no file is specified, then all that happens\n"
|
||||
"\n" " If no file is specified, then all that happens\n"
|
||||
" is that flash info is dumped.\n\n");
|
||||
exit(1);
|
||||
}
|
||||
|
@ -219,46 +217,42 @@ int main(int argc, char *argv[])
|
|||
struct flashchip *flash;
|
||||
int opt;
|
||||
int option_index = 0;
|
||||
int read_it = 0,
|
||||
write_it = 0,
|
||||
erase_it = 0,
|
||||
verify_it = 0;
|
||||
int read_it = 0, write_it = 0, erase_it = 0, verify_it = 0;
|
||||
int ret = 0;
|
||||
|
||||
static struct option long_options[]= {
|
||||
{ "read", 0, 0, 'r' },
|
||||
{ "write", 0, 0, 'w' },
|
||||
{ "erase", 0, 0, 'E' },
|
||||
{ "verify", 0, 0, 'v' },
|
||||
{ "chip", 1, 0, 'c' },
|
||||
{ "estart", 1, 0, 's' },
|
||||
{ "eend", 1, 0, 'e' },
|
||||
{ "mainboard", 1, 0, 'm' },
|
||||
{ "verbose", 0, 0, 'V' },
|
||||
{ "force", 0, 0, 'f' },
|
||||
{ "layout", 1, 0, 'l' },
|
||||
{ "image", 1, 0, 'i' },
|
||||
{ "help", 0, 0, 'h' },
|
||||
{ 0, 0, 0, 0 }
|
||||
static struct option long_options[] = {
|
||||
{"read", 0, 0, 'r'},
|
||||
{"write", 0, 0, 'w'},
|
||||
{"erase", 0, 0, 'E'},
|
||||
{"verify", 0, 0, 'v'},
|
||||
{"chip", 1, 0, 'c'},
|
||||
{"estart", 1, 0, 's'},
|
||||
{"eend", 1, 0, 'e'},
|
||||
{"mainboard", 1, 0, 'm'},
|
||||
{"verbose", 0, 0, 'V'},
|
||||
{"force", 0, 0, 'f'},
|
||||
{"layout", 1, 0, 'l'},
|
||||
{"image", 1, 0, 'i'},
|
||||
{"help", 0, 0, 'h'},
|
||||
{0, 0, 0, 0}
|
||||
};
|
||||
|
||||
char *filename = NULL;
|
||||
|
||||
|
||||
unsigned int exclude_start_position=0, exclude_end_position=0; // [x,y)
|
||||
char *tempstr=NULL, *tempstr2=NULL;
|
||||
unsigned int exclude_start_position = 0, exclude_end_position = 0; // [x,y)
|
||||
char *tempstr = NULL, *tempstr2 = NULL;
|
||||
|
||||
if (argc > 1) {
|
||||
/* Yes, print them. */
|
||||
int i;
|
||||
printf_debug ("The arguments are:\n");
|
||||
printf_debug("The arguments are:\n");
|
||||
for (i = 1; i < argc; ++i)
|
||||
printf_debug ("%s\n", argv[i]);
|
||||
printf_debug("%s\n", argv[i]);
|
||||
}
|
||||
|
||||
setbuf(stdout, NULL);
|
||||
while ((opt = getopt_long(argc, argv, "rwvVEfc:s:e:m:l:i:h", long_options,
|
||||
&option_index)) != EOF) {
|
||||
while ((opt = getopt_long(argc, argv, "rwvVEfc:s:e:m:l:i:h",
|
||||
long_options, &option_index)) != EOF) {
|
||||
switch (opt) {
|
||||
case 'r':
|
||||
read_it = 1;
|
||||
|
@ -280,34 +274,34 @@ int main(int argc, char *argv[])
|
|||
break;
|
||||
case 's':
|
||||
tempstr = strdup(optarg);
|
||||
sscanf(tempstr,"%x",&exclude_start_position);
|
||||
sscanf(tempstr, "%x", &exclude_start_position);
|
||||
break;
|
||||
case 'e':
|
||||
tempstr = strdup(optarg);
|
||||
sscanf(tempstr,"%x",&exclude_end_position);
|
||||
sscanf(tempstr, "%x", &exclude_end_position);
|
||||
break;
|
||||
case 'm':
|
||||
tempstr = strdup(optarg);
|
||||
strtok(tempstr, ":");
|
||||
tempstr2=strtok(NULL, ":");
|
||||
tempstr2 = strtok(NULL, ":");
|
||||
if (tempstr2) {
|
||||
lb_vendor=tempstr;
|
||||
lb_part=tempstr2;
|
||||
lb_vendor = tempstr;
|
||||
lb_part = tempstr2;
|
||||
} else {
|
||||
printf("warning: ignored wrong format of"
|
||||
" mainboard: %s\n", tempstr);
|
||||
}
|
||||
break;
|
||||
case 'f':
|
||||
force=1;
|
||||
force = 1;
|
||||
break;
|
||||
case 'l':
|
||||
tempstr=strdup(optarg);
|
||||
tempstr = strdup(optarg);
|
||||
if (read_romlayout(tempstr))
|
||||
exit(1);
|
||||
break;
|
||||
case 'i':
|
||||
tempstr=strdup(optarg);
|
||||
tempstr = strdup(optarg);
|
||||
find_romentry(tempstr);
|
||||
break;
|
||||
case 'h':
|
||||
|
@ -327,11 +321,12 @@ int main(int argc, char *argv[])
|
|||
|
||||
/* First get full io access */
|
||||
#if defined (__sun) && (defined(__i386) || defined(__amd64))
|
||||
if (sysi86(SI86V86, V86SC_IOPL, PS_IOPL) != 0){
|
||||
if (sysi86(SI86V86, V86SC_IOPL, PS_IOPL) != 0) {
|
||||
#else
|
||||
if (iopl(3) != 0) {
|
||||
#endif
|
||||
fprintf(stderr, "ERROR: iopl failed: \"%s\"\n", strerror(errno));
|
||||
fprintf(stderr, "ERROR: iopl failed: \"%s\"\n",
|
||||
strerror(errno));
|
||||
exit(1);
|
||||
}
|
||||
|
||||
|
@ -343,7 +338,8 @@ int main(int argc, char *argv[])
|
|||
|
||||
/* Open the memory device. A lot of functions need it */
|
||||
if ((fd_mem = open(MEM_DEV, O_RDWR)) < 0) {
|
||||
perror("Error: Can not access memory using " MEM_DEV ". You need to be root.");
|
||||
perror("Error: Can not access memory using " MEM_DEV
|
||||
". You need to be root.");
|
||||
exit(1);
|
||||
}
|
||||
|
||||
|
@ -358,13 +354,13 @@ int main(int argc, char *argv[])
|
|||
* really need this to be done, etc., etc.
|
||||
*/
|
||||
ret = chipset_flash_enable();
|
||||
if (ret == -2)
|
||||
if (ret == -2) {
|
||||
printf("WARNING: No chipset found. Flash detection "
|
||||
"will most likely fail.\n");
|
||||
}
|
||||
|
||||
board_flash_enable(lb_vendor, lb_part);
|
||||
|
||||
|
||||
if ((flash = probe_flash(flashchips)) == NULL) {
|
||||
printf("No EEPROM/flash device found.\n");
|
||||
exit(1);
|
||||
|
@ -392,13 +388,13 @@ int main(int argc, char *argv[])
|
|||
}
|
||||
printf("Reading Flash...");
|
||||
if (flash->read == NULL)
|
||||
memcpy(buf, (const char *) flash->virt_addr, size);
|
||||
memcpy(buf, (const char *)flash->virt_addr, size);
|
||||
else
|
||||
flash->read(flash, buf);
|
||||
|
||||
if (exclude_end_position - exclude_start_position > 0)
|
||||
memset(buf+exclude_start_position, 0,
|
||||
exclude_end_position-exclude_start_position);
|
||||
memset(buf + exclude_start_position, 0,
|
||||
exclude_end_position - exclude_start_position);
|
||||
|
||||
fwrite(buf, sizeof(char), size, image);
|
||||
fclose(image);
|
||||
|
@ -414,7 +410,7 @@ int main(int argc, char *argv[])
|
|||
perror(filename);
|
||||
exit(1);
|
||||
}
|
||||
if(image_stat.st_size!=flash->total_size*1024) {
|
||||
if (image_stat.st_size != flash->total_size * 1024) {
|
||||
fprintf(stderr, "Error: Image size doesnt match\n");
|
||||
exit(1);
|
||||
}
|
||||
|
@ -433,20 +429,20 @@ int main(int argc, char *argv[])
|
|||
|
||||
// ////////////////////////////////////////////////////////////
|
||||
if (exclude_end_position - exclude_start_position > 0)
|
||||
memcpy(buf+exclude_start_position,
|
||||
(const char *) flash->virt_addr+exclude_start_position,
|
||||
exclude_end_position-exclude_start_position);
|
||||
memcpy(buf + exclude_start_position,
|
||||
(const char *)flash->virt_addr + exclude_start_position,
|
||||
exclude_end_position - exclude_start_position);
|
||||
|
||||
exclude_start_page = exclude_start_position/flash->page_size;
|
||||
if ((exclude_start_position%flash->page_size) != 0) {
|
||||
exclude_start_page = exclude_start_position / flash->page_size;
|
||||
if ((exclude_start_position % flash->page_size) != 0) {
|
||||
exclude_start_page++;
|
||||
}
|
||||
exclude_end_page = exclude_end_position/flash->page_size;
|
||||
exclude_end_page = exclude_end_position / flash->page_size;
|
||||
// ////////////////////////////////////////////////////////////
|
||||
|
||||
// This should be moved into each flash part's code to do it
|
||||
// cleanly. This does the job.
|
||||
handle_romentries(buf, (uint8_t *)flash->virt_addr);
|
||||
handle_romentries(buf, (uint8_t *) flash->virt_addr);
|
||||
|
||||
// ////////////////////////////////////////////////////////////
|
||||
|
||||
|
|
|
@ -39,23 +39,23 @@ int probe_jedec(struct flashchip *flash)
|
|||
uint8_t id1, id2;
|
||||
|
||||
/* Issue JEDEC Product ID Entry command */
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0x90;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0x90;
|
||||
myusec_delay(10);
|
||||
|
||||
/* Read product ID */
|
||||
id1 = *(volatile uint8_t *) bios;
|
||||
id2 = *(volatile uint8_t *) (bios + 0x01);
|
||||
id1 = *(volatile uint8_t *)bios;
|
||||
id2 = *(volatile uint8_t *)(bios + 0x01);
|
||||
|
||||
/* Issue JEDEC Product ID Exit command */
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xF0;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xF0;
|
||||
myusec_delay(10);
|
||||
|
||||
printf_debug("%s: id1 0x%x, id2 0x%x\n", __FUNCTION__, id1, id2);
|
||||
|
@ -68,18 +68,18 @@ int probe_jedec(struct flashchip *flash)
|
|||
int erase_sector_jedec(volatile uint8_t *bios, unsigned int page)
|
||||
{
|
||||
/* Issue the Sector Erase command */
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0x80;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0x80;
|
||||
myusec_delay(10);
|
||||
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + page) = 0x30;
|
||||
*(volatile uint8_t *)(bios + page) = 0x30;
|
||||
myusec_delay(10);
|
||||
|
||||
/* wait for Toggle bit ready */
|
||||
|
@ -91,18 +91,18 @@ int erase_sector_jedec(volatile uint8_t *bios, unsigned int page)
|
|||
int erase_block_jedec(volatile uint8_t *bios, unsigned int block)
|
||||
{
|
||||
/* Issue the Sector Erase command */
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0x80;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0x80;
|
||||
myusec_delay(10);
|
||||
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + block) = 0x50;
|
||||
*(volatile uint8_t *)(bios + block) = 0x50;
|
||||
myusec_delay(10);
|
||||
|
||||
/* wait for Toggle bit ready */
|
||||
|
@ -116,18 +116,18 @@ int erase_chip_jedec(struct flashchip *flash)
|
|||
volatile uint8_t *bios = flash->virt_addr;
|
||||
|
||||
/* Issue the JEDEC Chip Erase command */
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0x80;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0x80;
|
||||
myusec_delay(10);
|
||||
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
myusec_delay(10);
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0x10;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0x10;
|
||||
myusec_delay(10);
|
||||
|
||||
toggle_ready_jedec(bios);
|
||||
|
@ -144,14 +144,14 @@ int write_page_write_jedec(volatile uint8_t *bios, uint8_t *src,
|
|||
|
||||
retry:
|
||||
/* Issue JEDEC Data Unprotect comand */
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xA0;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xA0;
|
||||
|
||||
/* transfer data from source to destination */
|
||||
for (i = start_index; i < page_size; i++) {
|
||||
/* If the data is 0xFF, don't program it */
|
||||
if (*src != 0xFF )
|
||||
if (*src != 0xFF)
|
||||
*dst = *src;
|
||||
dst++;
|
||||
src++;
|
||||
|
@ -163,8 +163,7 @@ retry:
|
|||
src = s;
|
||||
ok = 1;
|
||||
for (i = 0; i < page_size; i++) {
|
||||
if ( *dst != *src )
|
||||
{
|
||||
if (*dst != *src) {
|
||||
ok = 0;
|
||||
break;
|
||||
}
|
||||
|
@ -177,7 +176,8 @@ retry:
|
|||
goto retry;
|
||||
}
|
||||
if (!ok) {
|
||||
fprintf( stderr, " page %d failed!\n", (unsigned int)(d-bios)/page_size );
|
||||
fprintf(stderr, " page %d failed!\n",
|
||||
(unsigned int)(d - bios) / page_size);
|
||||
}
|
||||
return (!ok);
|
||||
}
|
||||
|
@ -194,9 +194,9 @@ int write_byte_program_jedec(volatile uint8_t *bios, uint8_t *src,
|
|||
|
||||
retry:
|
||||
/* Issue JEDEC Byte Program command */
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xA0;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xA0;
|
||||
|
||||
/* transfer data from source to destination */
|
||||
*dst = *src;
|
||||
|
@ -207,7 +207,7 @@ retry:
|
|||
}
|
||||
|
||||
if (tried >= MAX_REFLASH_TRIES)
|
||||
ok=0;
|
||||
ok = 0;
|
||||
|
||||
return (!ok);
|
||||
}
|
||||
|
@ -234,8 +234,8 @@ int write_jedec(struct flashchip *flash, uint8_t *buf)
|
|||
|
||||
erase_chip_jedec(flash);
|
||||
// dumb check if erase was successful.
|
||||
for (i=0; i < total_size; i++) {
|
||||
if (bios[i] != (uint8_t)0xff) {
|
||||
for (i = 0; i < total_size; i++) {
|
||||
if (bios[i] != (uint8_t) 0xff) {
|
||||
printf("ERASE FAILED\n");
|
||||
return -1;
|
||||
}
|
||||
|
|
|
@ -6,9 +6,9 @@
|
|||
#include "lbtable.h"
|
||||
#include "debug.h"
|
||||
|
||||
char * mainboard_vendor=NULL;
|
||||
char * mainboard_part=NULL;
|
||||
int romimages=0;
|
||||
char *mainboard_vendor = NULL;
|
||||
char *mainboard_part = NULL;
|
||||
int romimages = 0;
|
||||
|
||||
extern int force;
|
||||
|
||||
|
@ -25,46 +25,45 @@ romlayout_t rom_entries[MAX_ROMLAYOUT];
|
|||
|
||||
static char *def_name = "DEFAULT";
|
||||
|
||||
|
||||
int show_id(uint8_t *bios, int size)
|
||||
{
|
||||
unsigned int *walk;
|
||||
|
||||
|
||||
walk=(unsigned int *)(bios+size-0x10);
|
||||
walk = (unsigned int *)(bios + size - 0x10);
|
||||
walk--;
|
||||
|
||||
if((*walk)==0 || ((*walk)&0x3ff) != 0) {
|
||||
if ((*walk) == 0 || ((*walk) & 0x3ff) != 0) {
|
||||
/* We might have an Nvidia chipset bios
|
||||
* which stores the id information at a
|
||||
* different location.
|
||||
*/
|
||||
walk=(unsigned int *)(bios+size-0x80);
|
||||
walk = (unsigned int *)(bios + size - 0x80);
|
||||
walk--;
|
||||
}
|
||||
|
||||
if((*walk)==0 || ((*walk)&0x3ff) != 0) {
|
||||
if ((*walk) == 0 || ((*walk) & 0x3ff) != 0) {
|
||||
printf("Flash image seems to be a legacy BIOS. Disabling checks.\n");
|
||||
mainboard_vendor=def_name;
|
||||
mainboard_part=def_name;
|
||||
mainboard_vendor = def_name;
|
||||
mainboard_part = def_name;
|
||||
return 0;
|
||||
}
|
||||
|
||||
printf_debug("LinuxBIOS last image size "
|
||||
"(not rom size) is %d bytes.\n", *walk);
|
||||
|
||||
walk--; mainboard_part=strdup((const char *)(bios+size-*walk));
|
||||
walk--; mainboard_vendor=strdup((const char *)(bios+size-*walk));
|
||||
walk--;
|
||||
mainboard_part = strdup((const char *)(bios + size - *walk));
|
||||
walk--;
|
||||
mainboard_vendor = strdup((const char *)(bios + size - *walk));
|
||||
printf_debug("MANUFACTURER: %s\n", mainboard_vendor);
|
||||
printf_debug("MAINBOARD ID: %s\n", mainboard_part);
|
||||
|
||||
|
||||
/*
|
||||
* If lb_vendor is not set, the linuxbios table was
|
||||
* not found. Nor was -mVENDOR:PART specified
|
||||
*/
|
||||
|
||||
if(!lb_vendor || !lb_part) {
|
||||
if (!lb_vendor || !lb_part) {
|
||||
printf("Note: If the following flash access fails, "
|
||||
"you might need to specify -m <vendor>:<mainboard>\n");
|
||||
return 0;
|
||||
|
@ -74,12 +73,12 @@ int show_id(uint8_t *bios, int size)
|
|||
* a little less user^Werror prone.
|
||||
*/
|
||||
|
||||
if(!strcasecmp(mainboard_vendor, lb_vendor) &&
|
||||
if (!strcasecmp(mainboard_vendor, lb_vendor) &&
|
||||
!strcasecmp(mainboard_part, lb_part)) {
|
||||
printf_debug("This firmware image matches "
|
||||
"this motherboard.\n");
|
||||
} else {
|
||||
if(force) {
|
||||
if (force) {
|
||||
printf("WARNING: This firmware image does not "
|
||||
"seem to fit to this machine - forcing it.\n");
|
||||
} else {
|
||||
|
@ -89,7 +88,8 @@ int show_id(uint8_t *bios, int size)
|
|||
"are absolutely sure that you\nare using a correct "
|
||||
"image for this mainboard or override\nthe detected "
|
||||
"values with --mainboard <vendor>:<mainboard>.\n\n",
|
||||
mainboard_vendor, mainboard_part, lb_vendor, lb_part);
|
||||
mainboard_vendor, mainboard_part, lb_vendor,
|
||||
lb_part);
|
||||
exit(1);
|
||||
}
|
||||
}
|
||||
|
@ -103,36 +103,36 @@ int read_romlayout(char *name)
|
|||
char tempstr[256];
|
||||
int i;
|
||||
|
||||
romlayout=fopen (name, "r");
|
||||
romlayout = fopen(name, "r");
|
||||
|
||||
if(!romlayout) {
|
||||
if (!romlayout) {
|
||||
fprintf(stderr, "ERROR: Could not open rom layout (%s).\n",
|
||||
name);
|
||||
return -1;
|
||||
}
|
||||
|
||||
while(!feof(romlayout)) {
|
||||
while (!feof(romlayout)) {
|
||||
char *tstr1, *tstr2;
|
||||
fscanf(romlayout,"%s %s\n", tempstr, rom_entries[romimages].name);
|
||||
fscanf(romlayout, "%s %s\n", tempstr,
|
||||
rom_entries[romimages].name);
|
||||
#if 0
|
||||
// fscanf does not like arbitrary comments like that :( later
|
||||
if (tempstr[0]=='#') {
|
||||
if (tempstr[0] == '#') {
|
||||
continue;
|
||||
}
|
||||
#endif
|
||||
tstr1=strtok(tempstr,":");
|
||||
tstr2=strtok(NULL,":");
|
||||
rom_entries[romimages].start=strtol(tstr1, (char **)NULL, 16);
|
||||
rom_entries[romimages].end=strtol(tstr2, (char **)NULL, 16);
|
||||
rom_entries[romimages].included=0;
|
||||
tstr1 = strtok(tempstr, ":");
|
||||
tstr2 = strtok(NULL, ":");
|
||||
rom_entries[romimages].start = strtol(tstr1, (char **)NULL, 16);
|
||||
rom_entries[romimages].end = strtol(tstr2, (char **)NULL, 16);
|
||||
rom_entries[romimages].included = 0;
|
||||
romimages++;
|
||||
}
|
||||
|
||||
for(i=0; i<romimages; i++) {
|
||||
for (i = 0; i < romimages; i++) {
|
||||
printf_debug("romlayout %08x - %08x named %s\n",
|
||||
rom_entries[i].start,
|
||||
rom_entries[i].end,
|
||||
rom_entries[i].name);
|
||||
rom_entries[i].end, rom_entries[i].name);
|
||||
}
|
||||
|
||||
fclose(romlayout);
|
||||
|
@ -143,13 +143,14 @@ int find_romentry(char *name)
|
|||
{
|
||||
int i;
|
||||
|
||||
if(!romimages) return -1;
|
||||
if (!romimages)
|
||||
return -1;
|
||||
|
||||
printf("Looking for \"%s\"... ", name);
|
||||
|
||||
for (i=0; i<romimages; i++) {
|
||||
if(!strcmp(rom_entries[i].name, name)) {
|
||||
rom_entries[i].included=1;
|
||||
for (i = 0; i < romimages; i++) {
|
||||
if (!strcmp(rom_entries[i].name, name)) {
|
||||
rom_entries[i].included = 1;
|
||||
printf("found.\n");
|
||||
return i;
|
||||
}
|
||||
|
@ -178,15 +179,14 @@ int handle_romentries(uint8_t *buffer, uint8_t *content)
|
|||
// flash. Same thing if you specify -i normal -i all only
|
||||
// normal will be updated and the rest will be kept.
|
||||
|
||||
|
||||
for (i=0; i<romimages; i++) {
|
||||
for (i = 0; i < romimages; i++) {
|
||||
|
||||
if (rom_entries[i].included)
|
||||
continue;
|
||||
|
||||
memcpy (buffer+rom_entries[i].start,
|
||||
content+rom_entries[i].start,
|
||||
rom_entries[i].end-rom_entries[i].start);
|
||||
memcpy(buffer + rom_entries[i].start,
|
||||
content + rom_entries[i].start,
|
||||
rom_entries[i].end - rom_entries[i].start);
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
|
|
@ -11,7 +11,7 @@
|
|||
#include "linuxbios_tables.h"
|
||||
#include "debug.h"
|
||||
|
||||
char *lb_part=NULL, *lb_vendor=NULL;
|
||||
char *lb_part = NULL, *lb_vendor = NULL;
|
||||
|
||||
static unsigned long compute_checksum(void *addr, unsigned long length)
|
||||
{
|
||||
|
@ -27,7 +27,7 @@ static unsigned long compute_checksum(void *addr, unsigned long length)
|
|||
*/
|
||||
sum = 0;
|
||||
ptr = addr;
|
||||
for(i = 0; i < length; i++) {
|
||||
for (i = 0; i < length; i++) {
|
||||
unsigned long value;
|
||||
value = ptr[i];
|
||||
if (i & 1) {
|
||||
|
@ -52,7 +52,6 @@ static unsigned long compute_checksum(void *addr, unsigned long length)
|
|||
((((char *)rec) + rec->size) <= (((char *)head) + sizeof(*head) + head->table_bytes)); \
|
||||
rec = (struct lb_record *)(((char *)rec) + rec->size))
|
||||
|
||||
|
||||
static int count_lb_records(struct lb_header *head)
|
||||
{
|
||||
struct lb_record *rec;
|
||||
|
@ -64,17 +63,19 @@ static int count_lb_records(struct lb_header *head)
|
|||
return count;
|
||||
}
|
||||
|
||||
|
||||
static struct lb_header *find_lb_table(void *base, unsigned long start, unsigned long end)
|
||||
static struct lb_header *find_lb_table(void *base, unsigned long start,
|
||||
unsigned long end)
|
||||
{
|
||||
unsigned long addr;
|
||||
/* For now be stupid.... */
|
||||
for(addr = start; addr < end; addr += 16) {
|
||||
struct lb_header *head = (struct lb_header *)(((char*)base) + addr);
|
||||
struct lb_record *recs = (struct lb_record *)(((char*)base) + addr + sizeof(*head));
|
||||
for (addr = start; addr < end; addr += 16) {
|
||||
struct lb_header *head =
|
||||
(struct lb_header *)(((char *)base) + addr);
|
||||
struct lb_record *recs =
|
||||
(struct lb_record *)(((char *)base) + addr + sizeof(*head));
|
||||
if (memcmp(head->signature, "LBIO", 4) != 0)
|
||||
continue;
|
||||
printf_debug( "Found canidate at: %08lx-%08lx\n",
|
||||
printf_debug("Found canidate at: %08lx-%08lx\n",
|
||||
addr, addr + head->table_bytes);
|
||||
if (head->header_bytes != sizeof(*head)) {
|
||||
fprintf(stderr, "Header bytes of %d are incorrect\n",
|
||||
|
@ -86,7 +87,7 @@ static struct lb_header *find_lb_table(void *base, unsigned long start, unsigned
|
|||
head->table_entries);
|
||||
continue;
|
||||
}
|
||||
if (compute_checksum((uint8_t *)head, sizeof(*head)) != 0) {
|
||||
if (compute_checksum((uint8_t *) head, sizeof(*head)) != 0) {
|
||||
fprintf(stderr, "bad header checksum\n");
|
||||
continue;
|
||||
}
|
||||
|
@ -120,12 +121,11 @@ static void find_mainboard(struct lb_record *ptr, unsigned long addr)
|
|||
snprintf(part, 255, "%.*s", max_size - rec->part_number_idx,
|
||||
rec->strings + rec->part_number_idx);
|
||||
|
||||
if(lb_part) {
|
||||
printf("overwritten by command line, vendor id: %s part id: %s\n",
|
||||
lb_vendor, lb_part);
|
||||
if (lb_part) {
|
||||
printf("overwritten by command line, vendor id: %s part id: %s\n", lb_vendor, lb_part);
|
||||
} else {
|
||||
lb_part=strdup(part);
|
||||
lb_vendor=strdup(vendor);
|
||||
lb_part = strdup(part);
|
||||
lb_vendor = strdup(vendor);
|
||||
}
|
||||
}
|
||||
|
||||
|
@ -141,12 +141,12 @@ static void search_lb_records(struct lb_record *rec, struct lb_record *last,
|
|||
int count;
|
||||
count = 0;
|
||||
|
||||
for(next = next_record(rec); (rec < last) && (next <= last);
|
||||
for (next = next_record(rec); (rec < last) && (next <= last);
|
||||
rec = next, addr += rec->size) {
|
||||
next = next_record(rec);
|
||||
count++;
|
||||
if(rec->tag == LB_TAG_MAINBOARD) {
|
||||
find_mainboard(rec,addr);
|
||||
if (rec->tag == LB_TAG_MAINBOARD) {
|
||||
find_mainboard(rec, addr);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
@ -158,9 +158,11 @@ int linuxbios_init(void)
|
|||
struct lb_header *lb_table;
|
||||
struct lb_record *rec, *last;
|
||||
|
||||
low_1MB = mmap(0, 1024*1024, PROT_READ, MAP_SHARED, fd_mem, 0x00000000);
|
||||
low_1MB = mmap(0, 1024 * 1024, PROT_READ, MAP_SHARED, fd_mem,
|
||||
0x00000000);
|
||||
if (low_1MB == MAP_FAILED) {
|
||||
fprintf(stderr, "Can not mmap " MEM_DEV " at %08lx errno(%d):%s\n",
|
||||
fprintf(stderr,
|
||||
"Can not mmap " MEM_DEV " at %08lx errno(%d):%s\n",
|
||||
0x00000000UL, errno, strerror(errno));
|
||||
exit(-2);
|
||||
}
|
||||
|
@ -168,7 +170,7 @@ int linuxbios_init(void)
|
|||
if (!lb_table)
|
||||
lb_table = find_lb_table(low_1MB, 0x00000, 0x1000);
|
||||
if (!lb_table)
|
||||
lb_table = find_lb_table(low_1MB, 0xf0000, 1024*1024);
|
||||
lb_table = find_lb_table(low_1MB, 0xf0000, 1024 * 1024);
|
||||
if (lb_table) {
|
||||
unsigned long addr;
|
||||
addr = ((char *)lb_table) - ((char *)low_1MB);
|
||||
|
@ -177,10 +179,10 @@ int linuxbios_init(void)
|
|||
last = (struct lb_record *)(((char *)rec) + lb_table->table_bytes);
|
||||
printf_debug("LinuxBIOS header(%d) checksum: %04x table(%d) checksum: %04x entries: %d\n",
|
||||
lb_table->header_bytes, lb_table->header_checksum,
|
||||
lb_table->table_bytes, lb_table->table_checksum, lb_table->table_entries);
|
||||
lb_table->table_bytes, lb_table->table_checksum,
|
||||
lb_table->table_entries);
|
||||
search_lb_records(rec, last, addr + lb_table->header_bytes);
|
||||
}
|
||||
else {
|
||||
} else {
|
||||
printf("No LinuxBIOS table found.\n");
|
||||
return -1;
|
||||
}
|
||||
|
|
|
@ -64,10 +64,7 @@ static inline struct lb_uint64 pack_lb64(uint64_t value)
|
|||
return result;
|
||||
}
|
||||
|
||||
|
||||
|
||||
struct lb_header
|
||||
{
|
||||
struct lb_header {
|
||||
uint8_t signature[4]; /* LBIO */
|
||||
uint32_t header_bytes;
|
||||
uint32_t header_checksum;
|
||||
|
@ -167,7 +164,6 @@ struct cmos_entries {
|
|||
variable length int aligned */
|
||||
};
|
||||
|
||||
|
||||
/* cmos enumerations record
|
||||
This record is variable length. The text field may be
|
||||
shorter than CMOS_MAX_TEXT_LENGTH.
|
||||
|
@ -211,6 +207,4 @@ struct cmos_checksum {
|
|||
#define CHECKSUM_PCBIOS 1
|
||||
};
|
||||
|
||||
|
||||
|
||||
#endif /* LINUXBIOS_TABLES_H */
|
||||
|
|
|
@ -32,24 +32,23 @@ int probe_m29f400bt(struct flashchip *flash)
|
|||
volatile uint8_t *bios = flash->virt_addr;
|
||||
uint8_t id1, id2;
|
||||
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0x90;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0x90;
|
||||
|
||||
myusec_delay(10);
|
||||
|
||||
id1 = *(volatile uint8_t *) bios;
|
||||
id2 = *(volatile uint8_t *) (bios + 0x02);
|
||||
id1 = *(volatile uint8_t *)bios;
|
||||
id2 = *(volatile uint8_t *)(bios + 0x02);
|
||||
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0xF0;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0xF0;
|
||||
|
||||
myusec_delay(10);
|
||||
|
||||
printf_debug("%s: id1 0x%x, id2 0x%x\n", __FUNCTION__, id1, id2);
|
||||
|
||||
|
||||
if (id1 == flash->manufacture_id && id2 == flash->model_id)
|
||||
return 1;
|
||||
|
||||
|
@ -60,13 +59,13 @@ int erase_m29f400bt(struct flashchip *flash)
|
|||
{
|
||||
volatile uint8_t *bios = flash->virt_addr;
|
||||
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0x80;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0x80;
|
||||
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0x10;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0x10;
|
||||
|
||||
myusec_delay(10);
|
||||
toggle_ready_m29f400bt(bios);
|
||||
|
@ -77,12 +76,12 @@ int erase_m29f400bt(struct flashchip *flash)
|
|||
int block_erase_m29f400bt(volatile uint8_t *bios, volatile uint8_t *dst)
|
||||
{
|
||||
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0x80;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0x80;
|
||||
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x555) = 0x55;
|
||||
//*(volatile uint8_t *) (bios + 0xAAA) = 0x10;
|
||||
*dst = 0x30;
|
||||
|
||||
|
@ -95,8 +94,8 @@ int block_erase_m29f400bt(volatile uint8_t *bios, volatile uint8_t *dst)
|
|||
int write_m29f400bt(struct flashchip *flash, uint8_t *buf)
|
||||
{
|
||||
int i;
|
||||
int total_size = flash->total_size * 1024, page_size =
|
||||
flash->page_size;
|
||||
int total_size = flash->total_size * 1024;
|
||||
int page_size = flash->page_size;
|
||||
volatile uint8_t *bios = flash->virt_addr;
|
||||
|
||||
//erase_m29f400bt (flash);
|
||||
|
@ -122,29 +121,24 @@ int write_m29f400bt(struct flashchip *flash, uint8_t *buf)
|
|||
block_erase_m29f400bt(bios, bios + i * page_size);
|
||||
write_page_m29f400bt(bios, buf + i * page_size,
|
||||
bios + i * page_size, page_size);
|
||||
printf
|
||||
("\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b");
|
||||
printf("\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b");
|
||||
}
|
||||
|
||||
printf("%04d at address: 0x%08x\n", 7, 0x70000);
|
||||
block_erase_m29f400bt(bios, bios + 0x70000);
|
||||
write_page_m29f400bt(bios, buf + 0x70000, bios + 0x70000,
|
||||
32 * 1024);
|
||||
write_page_m29f400bt(bios, buf + 0x70000, bios + 0x70000, 32 * 1024);
|
||||
|
||||
printf("%04d at address: 0x%08x\n", 8, 0x78000);
|
||||
block_erase_m29f400bt(bios, bios + 0x78000);
|
||||
write_page_m29f400bt(bios, buf + 0x78000, bios + 0x78000,
|
||||
8 * 1024);
|
||||
write_page_m29f400bt(bios, buf + 0x78000, bios + 0x78000, 8 * 1024);
|
||||
|
||||
printf("%04d at address: 0x%08x\n", 9, 0x7a000);
|
||||
block_erase_m29f400bt(bios, bios + 0x7a000);
|
||||
write_page_m29f400bt(bios, buf + 0x7a000, bios + 0x7a000,
|
||||
8 * 1024);
|
||||
write_page_m29f400bt(bios, buf + 0x7a000, bios + 0x7a000, 8 * 1024);
|
||||
|
||||
printf("%04d at address: 0x%08x\n", 10, 0x7c000);
|
||||
block_erase_m29f400bt(bios, bios + 0x7c000);
|
||||
write_page_m29f400bt(bios, buf + 0x7c000, bios + 0x7c000,
|
||||
16 * 1024);
|
||||
write_page_m29f400bt(bios, buf + 0x7c000, bios + 0x7c000, 16 * 1024);
|
||||
|
||||
printf("\n");
|
||||
//protect_m29f400bt (bios);
|
||||
|
@ -174,23 +168,19 @@ int write_linuxbios_m29f400bt(struct flashchip *flash, uint8_t *buf)
|
|||
*********************************/
|
||||
printf("%04d at address: 0x%08x\n", 7, 0x00000);
|
||||
block_erase_m29f400bt(bios, bios + 0x00000);
|
||||
write_page_m29f400bt(bios, buf + 0x00000, bios + 0x00000,
|
||||
64 * 1024);
|
||||
write_page_m29f400bt(bios, buf + 0x00000, bios + 0x00000, 64 * 1024);
|
||||
|
||||
printf("%04d at address: 0x%08x\n", 7, 0x10000);
|
||||
block_erase_m29f400bt(bios, bios + 0x10000);
|
||||
write_page_m29f400bt(bios, buf + 0x10000, bios + 0x10000,
|
||||
64 * 1024);
|
||||
write_page_m29f400bt(bios, buf + 0x10000, bios + 0x10000, 64 * 1024);
|
||||
|
||||
printf("%04d at address: 0x%08x\n", 7, 0x20000);
|
||||
block_erase_m29f400bt(bios, bios + 0x20000);
|
||||
write_page_m29f400bt(bios, buf + 0x20000, bios + 0x20000,
|
||||
64 * 1024);
|
||||
write_page_m29f400bt(bios, buf + 0x20000, bios + 0x20000, 64 * 1024);
|
||||
|
||||
printf("%04d at address: 0x%08x\n", 7, 0x30000);
|
||||
block_erase_m29f400bt(bios, bios + 0x30000);
|
||||
write_page_m29f400bt(bios, buf + 0x30000, bios + 0x30000,
|
||||
64 * 1024);
|
||||
write_page_m29f400bt(bios, buf + 0x30000, bios + 0x30000, 64 * 1024);
|
||||
|
||||
printf("\n");
|
||||
//protect_m29f400bt (bios);
|
||||
|
|
|
@ -5,10 +5,10 @@
|
|||
|
||||
extern int probe_m29f400bt(struct flashchip *flash);
|
||||
extern int erase_m29f400bt(struct flashchip *flash);
|
||||
extern int block_erase_m29f400bt(volatile uint8_t *bios, volatile uint8_t *dst);
|
||||
extern int block_erase_m29f400bt(volatile uint8_t *bios,
|
||||
volatile uint8_t *dst);
|
||||
extern int write_m29f400bt(struct flashchip *flash, uint8_t *buf);
|
||||
extern int write_linuxbios_m29f400bt(struct flashchip *flash,
|
||||
uint8_t *buf);
|
||||
extern int write_linuxbios_m29f400bt(struct flashchip *flash, uint8_t *buf);
|
||||
|
||||
extern __inline__ void toggle_ready_m29f400bt(volatile uint8_t *dst)
|
||||
{
|
||||
|
@ -44,23 +44,24 @@ extern __inline__ void data_polling_m29f400bt(volatile uint8_t *dst,
|
|||
|
||||
extern __inline__ void protect_m29f400bt(volatile uint8_t *bios)
|
||||
{
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0xA0;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0xA0;
|
||||
|
||||
usleep(200);
|
||||
}
|
||||
|
||||
extern __inline__ void write_page_m29f400bt(volatile uint8_t *bios, uint8_t *src,
|
||||
extern __inline__ void write_page_m29f400bt(volatile uint8_t *bios,
|
||||
uint8_t *src,
|
||||
volatile uint8_t *dst,
|
||||
int page_size)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i = 0; i < page_size; i++) {
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0xAAA) = 0xA0;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x555) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0xAAA) = 0xA0;
|
||||
|
||||
/* transfer data from source to destination */
|
||||
*dst = *src;
|
||||
|
|
|
@ -19,27 +19,18 @@
|
|||
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
*/
|
||||
|
||||
|
||||
|
||||
#include <stdio.h>
|
||||
#include <unistd.h>
|
||||
#include "flash.h"
|
||||
#include "msys_doc.h"
|
||||
#include "debug.h"
|
||||
|
||||
|
||||
|
||||
|
||||
static int doc_wait(volatile uint8_t *bios, int timeout);
|
||||
static uint8_t doc_read_chipid(volatile uint8_t *bios);
|
||||
static uint8_t doc_read_docstatus(volatile uint8_t *bios);
|
||||
static uint8_t doc_read_cdsncontrol(volatile uint8_t *bios);
|
||||
static void doc_write_cdsncontrol(volatile uint8_t *bios, uint8_t data);
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
int probe_md2802(struct flashchip *flash)
|
||||
{
|
||||
volatile uint8_t *bios = flash->virt_addr;
|
||||
|
@ -72,11 +63,9 @@ int probe_md2802(struct flashchip *flash)
|
|||
|
||||
printf("%s: switching off write protection ...\n", __FUNCTION__);
|
||||
doc_write_cdsncontrol(bios, doc_read_cdsncontrol(bios) & (~0x08));
|
||||
printf("%s: switching off write protection ... done\n",
|
||||
__FUNCTION__);
|
||||
printf("%s: switching off write protection ... done\n", __FUNCTION__);
|
||||
printf("%s:\n", __FUNCTION__);
|
||||
|
||||
|
||||
chipid = doc_read_chipid(bios);
|
||||
#ifndef MSYSTEMS_DOC_NO_55AA_CHECKING
|
||||
id_0x55 = doc_read(bios, IPL_0x0000);
|
||||
|
@ -140,8 +129,7 @@ int probe_md2802(struct flashchip *flash)
|
|||
printf("\n%s: toggle result: %d/%d\n", __FUNCTION__, toggle_a,
|
||||
toggle_b);
|
||||
|
||||
if (chipid == flash->model_id
|
||||
&& ((toggle_a == 5 && toggle_b == 0)
|
||||
if (chipid == flash->model_id && ((toggle_a == 5 && toggle_b == 0)
|
||||
|| (toggle_a == 0 && toggle_b == 5))
|
||||
#ifndef MSYSTEMS_DOC_NO_55AA_CHECKING
|
||||
&& id_0x55 == 0x55 && id_0xAA == 0xaa
|
||||
|
@ -153,37 +141,31 @@ int probe_md2802(struct flashchip *flash)
|
|||
return (0);
|
||||
} /* int probe_md2802(struct flashchip *flash) */
|
||||
|
||||
|
||||
|
||||
int read_md2802(struct flashchip *flash, uint8_t *buf)
|
||||
{
|
||||
|
||||
return (0);
|
||||
} /* int read_md2802(struct flashchip *flash, uint8_t *buf) */
|
||||
|
||||
|
||||
|
||||
int erase_md2802(struct flashchip *flash)
|
||||
{
|
||||
volatile uint8_t *bios = flash->virt_addr;
|
||||
|
||||
return (1);
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0x80;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0x80;
|
||||
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0x10;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0x10;
|
||||
} /* int erase_md2802(struct flashchip *flash) */
|
||||
|
||||
|
||||
|
||||
int write_md2802(struct flashchip *flash, uint8_t *buf)
|
||||
{
|
||||
int i;
|
||||
int total_size = flash->total_size * 1024, page_size =
|
||||
flash->page_size;
|
||||
int total_size = flash->total_size * 1024;
|
||||
int page_size = flash->page_size;
|
||||
volatile uint8_t *bios = flash->virt_addr;
|
||||
|
||||
return (1);
|
||||
|
@ -205,11 +187,6 @@ int write_md2802(struct flashchip *flash, uint8_t *buf)
|
|||
return 0;
|
||||
} /* int write_md2802(struct flashchip *flash, uint8_t *buf) */
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
/*
|
||||
wait timeout msec for doc to become ready
|
||||
return:
|
||||
|
@ -237,8 +214,6 @@ static int doc_wait(volatile uint8_t *bios, int timeout)
|
|||
return (0);
|
||||
} /* static int doc_wait(volatile uint8_t *bios, int timeout) */
|
||||
|
||||
|
||||
|
||||
static uint8_t doc_read_docstatus(volatile uint8_t *bios)
|
||||
{
|
||||
doc_read(bios, CDSNSlowIO);
|
||||
|
@ -247,8 +222,6 @@ static uint8_t doc_read_docstatus(volatile uint8_t *bios)
|
|||
return (doc_read(bios, _DOCStatus));
|
||||
} /* static uint8_t doc_read_docstatus(volatile uint8_t *bios) */
|
||||
|
||||
|
||||
|
||||
static uint8_t doc_read_chipid(volatile uint8_t *bios)
|
||||
{
|
||||
doc_read(bios, CDSNSlowIO);
|
||||
|
@ -257,8 +230,6 @@ static uint8_t doc_read_chipid(volatile uint8_t *bios)
|
|||
return (doc_read(bios, _ChipID));
|
||||
} /* static uint8_t doc_read_chipid(volatile uint8_t *bios) */
|
||||
|
||||
|
||||
|
||||
static uint8_t doc_read_cdsncontrol(volatile uint8_t *bios)
|
||||
{
|
||||
uint8_t value;
|
||||
|
@ -273,8 +244,6 @@ static uint8_t doc_read_cdsncontrol(volatile uint8_t *bios)
|
|||
return (value);
|
||||
} /* static uint8_t doc_read_chipid(volatile char *bios) */
|
||||
|
||||
|
||||
|
||||
static void doc_write_cdsncontrol(volatile uint8_t *bios, uint8_t data)
|
||||
{
|
||||
doc_write(data, bios, _CDSNControl);
|
||||
|
|
|
@ -51,9 +51,9 @@ int probe_lhf00l04(struct flashchip *flash)
|
|||
uint8_t id1, id2;
|
||||
|
||||
#if 0
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0x90;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0x90;
|
||||
#endif
|
||||
|
||||
*bios = 0xff;
|
||||
|
@ -61,13 +61,13 @@ int probe_lhf00l04(struct flashchip *flash)
|
|||
*bios = 0x90;
|
||||
myusec_delay(10);
|
||||
|
||||
id1 = *(volatile uint8_t *) bios;
|
||||
id2 = *(volatile uint8_t *) (bios + 0x01);
|
||||
id1 = *(volatile uint8_t *)bios;
|
||||
id2 = *(volatile uint8_t *)(bios + 0x01);
|
||||
|
||||
#if 1
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xF0;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xF0;
|
||||
|
||||
#endif
|
||||
myusec_delay(10);
|
||||
|
@ -86,7 +86,8 @@ int probe_lhf00l04(struct flashchip *flash)
|
|||
}
|
||||
|
||||
flash->virt_addr_2 = bios;
|
||||
printf("bios %p, *bios 0x%x, bios[1] 0x%x\n", bios, *bios, bios[1]);
|
||||
printf("bios %p, *bios 0x%x, bios[1] 0x%x\n", bios, *bios,
|
||||
bios[1]);
|
||||
return 1;
|
||||
}
|
||||
|
||||
|
@ -101,7 +102,7 @@ uint8_t wait_lhf00l04(volatile uint8_t *bios)
|
|||
|
||||
*bios = 0x70;
|
||||
if ((*bios & 0x80) == 0) { // it's busy
|
||||
while ((*bios & 0x80) == 0);
|
||||
while ((*bios & 0x80) == 0) ;
|
||||
}
|
||||
|
||||
status = *bios;
|
||||
|
@ -111,21 +112,20 @@ uint8_t wait_lhf00l04(volatile uint8_t *bios)
|
|||
*bios = 0x90;
|
||||
myusec_delay(10);
|
||||
|
||||
id1 = *(volatile uint8_t *) bios;
|
||||
id2 = *(volatile uint8_t *) (bios + 0x01);
|
||||
id1 = *(volatile uint8_t *)bios;
|
||||
id2 = *(volatile uint8_t *)(bios + 0x01);
|
||||
|
||||
// this is needed to jam it out of "read id" mode
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *) (bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *) (bios + 0x5555) = 0xF0;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xAA;
|
||||
*(volatile uint8_t *)(bios + 0x2AAA) = 0x55;
|
||||
*(volatile uint8_t *)(bios + 0x5555) = 0xF0;
|
||||
return status;
|
||||
|
||||
}
|
||||
int erase_lhf00l04_block(struct flashchip *flash, int offset)
|
||||
{
|
||||
volatile uint8_t *bios = flash->virt_addr + offset;
|
||||
volatile uint8_t *wrprotect =
|
||||
flash->virt_addr_2 + offset + 2;
|
||||
volatile uint8_t *wrprotect = flash->virt_addr_2 + offset + 2;
|
||||
uint8_t status;
|
||||
|
||||
// clear status register
|
||||
|
@ -140,8 +140,8 @@ int erase_lhf00l04_block(struct flashchip *flash, int offset)
|
|||
printf("write protect is 0x%x\n", *(wrprotect));
|
||||
|
||||
// now start it
|
||||
*(volatile uint8_t *) (bios) = 0x20;
|
||||
*(volatile uint8_t *) (bios) = 0xd0;
|
||||
*(volatile uint8_t *)(bios) = 0x20;
|
||||
*(volatile uint8_t *)(bios) = 0xd0;
|
||||
myusec_delay(10);
|
||||
// now let's see what the register is
|
||||
status = wait_lhf00l04(flash->virt_addr);
|
||||
|
@ -162,8 +162,8 @@ int erase_lhf00l04(struct flashchip *flash)
|
|||
return (0);
|
||||
}
|
||||
|
||||
void write_page_lhf00l04(volatile uint8_t *bios, uint8_t *src, volatile uint8_t *dst,
|
||||
int page_size)
|
||||
void write_page_lhf00l04(volatile uint8_t *bios, uint8_t *src,
|
||||
volatile uint8_t *dst, int page_size)
|
||||
{
|
||||
int i;
|
||||
|
||||
|
@ -179,8 +179,8 @@ void write_page_lhf00l04(volatile uint8_t *bios, uint8_t *src, volatile uint8_t
|
|||
int write_lhf00l04(struct flashchip *flash, uint8_t *buf)
|
||||
{
|
||||
int i;
|
||||
int total_size = flash->total_size * 1024, page_size =
|
||||
flash->page_size;
|
||||
int total_size = flash->total_size * 1024;
|
||||
int page_size = flash->page_size;
|
||||
volatile uint8_t *bios = flash->virt_addr;
|
||||
|
||||
erase_lhf00l04(flash);
|
||||
|
@ -193,8 +193,7 @@ int write_lhf00l04(struct flashchip *flash, uint8_t *buf)
|
|||
printf("%04d at address: 0x%08x", i, i * page_size);
|
||||
write_page_lhf00l04(bios, buf + i * page_size,
|
||||
bios + i * page_size, page_size);
|
||||
printf
|
||||
("\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b");
|
||||
printf("\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b");
|
||||
}
|
||||
printf("\n");
|
||||
protect_lhf00l04(bios);
|
||||
|
|
|
@ -43,13 +43,13 @@ static __inline__ void protect_28sf040(volatile uint8_t *bios)
|
|||
/* ask compiler not to optimize this */
|
||||
volatile uint8_t tmp;
|
||||
|
||||
tmp = *(volatile uint8_t *) (bios + 0x1823);
|
||||
tmp = *(volatile uint8_t *) (bios + 0x1820);
|
||||
tmp = *(volatile uint8_t *) (bios + 0x1822);
|
||||
tmp = *(volatile uint8_t *) (bios + 0x0418);
|
||||
tmp = *(volatile uint8_t *) (bios + 0x041B);
|
||||
tmp = *(volatile uint8_t *) (bios + 0x0419);
|
||||
tmp = *(volatile uint8_t *) (bios + 0x040A);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x1823);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x1820);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x1822);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x0418);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x041B);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x0419);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x040A);
|
||||
}
|
||||
|
||||
static __inline__ void unprotect_28sf040(volatile uint8_t *bios)
|
||||
|
@ -57,13 +57,13 @@ static __inline__ void unprotect_28sf040(volatile uint8_t *bios)
|
|||
/* ask compiler not to optimize this */
|
||||
volatile uint8_t tmp;
|
||||
|
||||
tmp = *(volatile uint8_t *) (bios + 0x1823);
|
||||
tmp = *(volatile uint8_t *) (bios + 0x1820);
|
||||
tmp = *(volatile uint8_t *) (bios + 0x1822);
|
||||
tmp = *(volatile uint8_t *) (bios + 0x0418);
|
||||
tmp = *(volatile uint8_t *) (bios + 0x041B);
|
||||
tmp = *(volatile uint8_t *) (bios + 0x0419);
|
||||
tmp = *(volatile uint8_t *) (bios + 0x041A);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x1823);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x1820);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x1822);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x0418);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x041B);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x0419);
|
||||
tmp = *(volatile uint8_t *)(bios + 0x041A);
|
||||
}
|
||||
|
||||
static __inline__ int erase_sector_28sf040(volatile uint8_t *bios,
|
||||
|
@ -116,9 +116,9 @@ int probe_28sf040(struct flashchip *flash)
|
|||
|
||||
*bios = READ_ID;
|
||||
myusec_delay(10);
|
||||
id1 = *(volatile uint8_t *) bios;
|
||||
id1 = *(volatile uint8_t *)bios;
|
||||
myusec_delay(10);
|
||||
id2 = *(volatile uint8_t *) (bios + 0x01);
|
||||
id2 = *(volatile uint8_t *)(bios + 0x01);
|
||||
|
||||
*bios = RESET;
|
||||
myusec_delay(10);
|
||||
|
@ -150,8 +150,8 @@ int erase_28sf040(struct flashchip *flash)
|
|||
int write_28sf040(struct flashchip *flash, uint8_t *buf)
|
||||
{
|
||||
int i;
|
||||
int total_size = flash->total_size * 1024, page_size =
|
||||
flash->page_size;
|
||||
int total_size = flash->total_size * 1024;
|
||||
int page_size = flash->page_size;
|
||||
volatile uint8_t *bios = flash->virt_addr;
|
||||
|
||||
unprotect_28sf040(bios);
|
||||
|
|
|
@ -50,7 +50,6 @@
|
|||
#define STATUS_ESS (1 << 6)
|
||||
#define STATUS_WSMS (1 << 7)
|
||||
|
||||
|
||||
static __inline__ int write_lockbits_49lfxxxc(volatile uint8_t *bios, int size,
|
||||
unsigned char bits)
|
||||
{
|
||||
|
@ -75,7 +74,6 @@ static __inline__ int write_lockbits_49lfxxxc(volatile uint8_t *bios, int size,
|
|||
//printf("lockbits at address=0x%08lx is 0x%01x\n", (unsigned long)0xFFc00000 - size + address + 2, *(bios + address + 2) );
|
||||
*(bios + address + 2) = bits;
|
||||
|
||||
|
||||
return (0);
|
||||
}
|
||||
|
||||
|
@ -92,7 +90,7 @@ static __inline__ int erase_sector_49lfxxxc(volatile uint8_t *bios,
|
|||
if (status & (STATUS_ESS | STATUS_BPS)) {
|
||||
printf("sector erase FAILED at address=0x%08lx status=0x%01x\n", (unsigned long)bios + address, status);
|
||||
*bios = CLEAR_STATUS;
|
||||
return(-1);
|
||||
return (-1);
|
||||
}
|
||||
} while (!(status & STATUS_WSMS));
|
||||
|
||||
|
@ -124,7 +122,7 @@ static __inline__ int write_sector_49lfxxxc(volatile uint8_t *bios,
|
|||
if (status & (STATUS_ESS | STATUS_BPS)) {
|
||||
printf("sector write FAILED at address=0x%08lx status=0x%01x\n", (unsigned long)dst, status);
|
||||
*bios = CLEAR_STATUS;
|
||||
return(-1);
|
||||
return (-1);
|
||||
}
|
||||
} while (!(status & STATUS_WSMS));
|
||||
}
|
||||
|
@ -141,8 +139,8 @@ int probe_49lfxxxc(struct flashchip *flash)
|
|||
*bios = RESET;
|
||||
|
||||
*bios = READ_ID;
|
||||
id1 = *(volatile uint8_t *) bios;
|
||||
id2 = *(volatile uint8_t *) (bios + 0x01);
|
||||
id1 = *(volatile uint8_t *)bios;
|
||||
id2 = *(volatile uint8_t *)(bios + 0x01);
|
||||
|
||||
*bios = RESET;
|
||||
|
||||
|
@ -170,7 +168,7 @@ int erase_49lfxxxc(struct flashchip *flash)
|
|||
|
||||
write_lockbits_49lfxxxc(bios2, total_size, 0);
|
||||
for (i = 0; i < total_size; i += flash->page_size)
|
||||
if (erase_sector_49lfxxxc(bios, i) != 0 )
|
||||
if (erase_sector_49lfxxxc(bios, i) != 0)
|
||||
return (-1);
|
||||
|
||||
*bios = RESET;
|
||||
|
@ -180,11 +178,10 @@ int erase_49lfxxxc(struct flashchip *flash)
|
|||
int write_49lfxxxc(struct flashchip *flash, uint8_t *buf)
|
||||
{
|
||||
int i;
|
||||
int total_size = flash->total_size * 1024, page_size =
|
||||
flash->page_size;
|
||||
int total_size = flash->total_size * 1024;
|
||||
int page_size = flash->page_size;
|
||||
volatile uint8_t *bios = flash->virt_addr;
|
||||
|
||||
|
||||
write_lockbits_49lfxxxc(flash->virt_addr_2, total_size, 0);
|
||||
printf("Programming Page: ");
|
||||
for (i = 0; i < total_size / page_size; i++) {
|
||||
|
|
Loading…
Reference in New Issue