URL https://opencores.org/ocsvn/zet86/zet86/trunk

Subversion Repositories zet86

[/] [zet86/] [trunk/] [soc/] [bios/] [biossums.c] - Blame information for rev 52

Details | Compare with Previous | View Log


/*
 * $Id: biossums.c,v 1.4 2007/05/28 08:09:13 vruppert Exp $
 *
 *  This library is free software; you can redistribute it and/or
 *  modify it under the terms of the GNU Lesser General Public
 *  License as published by the Free Software Foundation; either
 *  version 2 of the License, or (at your option) any later version.
 *
 *  This library is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 *  Lesser General Public License for more details.
 *
 *  You should have received a copy of the GNU Lesser General Public
 *  License along with this library; if not, write to the Free Software
 *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301 USA
 */
 
/* biossums.c  --- written by Eike W. for the Bochs BIOS */
 
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
 
typedef unsigned char byte;
 
void check( int value, char* message );
 
#define LEN_BIOS_DATA 0x10000
#define MAX_OFFSET    (LEN_BIOS_DATA - 1)
 
 
#define BIOS_OFFSET 0xFFFF
 
long chksum_bios_get_offset( byte* data, long offset );
byte chksum_bios_calc_value( byte* data, long offset );
byte chksum_bios_get_value(  byte* data, long offset );
void chksum_bios_set_value(  byte* data, long offset, byte value );
 
 
#define _32__LEN         9
#define _32__CHKSUM     10
 
#define _32__MINHDR     16
 
long chksum__32__get_offset( byte* data, long offset );
byte chksum__32__calc_value( byte* data, long offset );
byte chksum__32__get_value(  byte* data, long offset );
void chksum__32__set_value(  byte* data, long offset, byte value );
 
 
#define _MP__LEN         8
#define _MP__CHKSUM     10
 
#define _MP__MINHDR     16
 
long chksum__mp__get_offset( byte* data, long offset );
byte chksum__mp__calc_value( byte* data, long offset );
byte chksum__mp__get_value(  byte* data, long offset );
void chksum__mp__set_value(  byte* data, long offset, byte value );
 
 
#define PCMP_BASELEN     4
#define PCMP_CHKSUM      7
#define PCMP_EXT_LEN    40
#define PCMP_EXT_CHKSUM 42
 
#define PCMP_MINHDR     42
 
long chksum_pcmp_get_offset( byte* data, long offset );
byte chksum_pcmp_calc_value( byte* data, long offset );
byte chksum_pcmp_get_value(  byte* data, long offset );
void chksum_pcmp_set_value(  byte* data, long offset, byte value );
 
 
#define _PIR_LEN         6
#define _PIR_CHKSUM     31
 
#define _PIR_MINHDR     32
 
long chksum__pir_get_offset( byte *data, long offset );
byte chksum__pir_calc_value( byte* data, long offset );
byte chksum__pir_get_value(  byte* data, long offset );
void chksum__pir_set_value(  byte* data, long offset, byte value );
 
 
byte bios_data[LEN_BIOS_DATA];
long bios_len;
 
 
int main(int argc, char* argv[]) {
 
  FILE* stream;
  long  offset, tmp_offset;
  byte  cur_val = 0, new_val = 0;
  int   arg = 1, hits, pad = 0;
 
 
  if ((argc == 3) && (!strcmp(argv[1], "-pad"))) {
    pad = 1;
    arg = 2;
  } else if (argc != 2) {
    printf("Error. Need a file-name as an argument.\n");
    exit(EXIT_FAILURE);
  }
  memset(bios_data, 0xff, LEN_BIOS_DATA);
 
  if ((stream = fopen(argv[arg], "rb")) == NULL) {
    printf("Error opening %s for reading.\n", argv[arg]);
    exit(EXIT_FAILURE);
  }
  bios_len = fread(bios_data, 1, LEN_BIOS_DATA, stream);
  if ((bios_len < LEN_BIOS_DATA) && (pad == 0)) {
    printf("Error reading 64KBytes from %s.\n", argv[arg]);
    fclose(stream);
    exit(EXIT_FAILURE);
  }
  fclose(stream);
  if (pad == 1) goto write_bios;
 
  hits   = 0;
  offset = 0L;
  while( (tmp_offset = chksum__32__get_offset( bios_data, offset )) != -1L ) {
    offset  = tmp_offset;
    cur_val = chksum__32__get_value(  bios_data, offset );
    new_val = chksum__32__calc_value( bios_data, offset );
    printf( "\n\nPCI-Bios header at: 0x%4lX\n", offset  );
    printf( "Current checksum:     0x%02X\n",   cur_val );
    printf( "Calculated checksum:  0x%02X  ",   new_val );
    hits++;
  }
  if( hits == 1 && cur_val != new_val ) {
    printf( "Setting checksum." );
    chksum__32__set_value( bios_data, offset, new_val );
  }
  if( hits >= 2 ) {
    printf( "Multiple PCI headers! No checksum set." );
  }
  if( hits ) {
    printf( "\n" );
  }
 
 
  hits   = 0;
  offset = 0L;
  while( (tmp_offset = chksum__mp__get_offset( bios_data, offset )) != -1L ) {
    offset  = tmp_offset;
    cur_val = chksum__mp__get_value(  bios_data, offset );
    new_val = chksum__mp__calc_value( bios_data, offset );
    printf( "\n\nMP header at:       0x%4lX\n", offset  );
    printf( "Current checksum:     0x%02X\n",   cur_val );
    printf( "Calculated checksum:  0x%02X  ",   new_val );
    hits++;
  }
  if( hits == 1 && cur_val != new_val ) {
    printf( "Setting checksum." );
    chksum__mp__set_value( bios_data, offset, new_val );
  }
  if( hits >= 2 ) {
    printf( "Warning! Multiple MP headers. No checksum set." );
  }
  if( hits ) {
    printf( "\n" );
  }
 
 
  hits   = 0;
  offset = 0L;
  while( (tmp_offset = chksum_pcmp_get_offset( bios_data, offset )) != -1L ) {
    offset  = tmp_offset;
    cur_val = chksum_pcmp_get_value(  bios_data, offset );
    new_val = chksum_pcmp_calc_value( bios_data, offset );
    printf( "\n\nPCMP header at:     0x%4lX\n", offset  );
    printf( "Current checksum:     0x%02X\n",   cur_val );
    printf( "Calculated checksum:  0x%02X  ",   new_val );
    hits++;
  }
  if( hits == 1 && cur_val != new_val ) {
    printf( "Setting checksum." );
    chksum_pcmp_set_value( bios_data, offset, new_val );
  }
  if( hits >= 2 ) {
    printf( "Warning! Multiple PCMP headers. No checksum set." );
  }
  if( hits ) {
    printf( "\n" );
  }
 
 
  hits   = 0;
  offset = 0L;
  while( (tmp_offset = chksum__pir_get_offset( bios_data, offset )) != -1L ) {
    offset  = tmp_offset;
    cur_val = chksum__pir_get_value(  bios_data, offset );
    new_val = chksum__pir_calc_value( bios_data, offset );
    printf( "\n\n$PIR header at:     0x%4lX\n", offset  );
    printf( "Current checksum:     0x%02X\n",   cur_val );
    printf( "Calculated checksum:  0x%02X\n  ",  new_val );
    hits++;
  }
  if( hits == 1 && cur_val != new_val ) {
    printf( "Setting checksum." );
    chksum__pir_set_value( bios_data, offset, new_val );
  }
  if( hits >= 2 ) {
    printf( "Warning! Multiple $PIR headers. No checksum set." );
  }
  if( hits ) {
    printf( "\n" );
  }
 
 
  offset  = 0L;
  offset  = chksum_bios_get_offset( bios_data, offset );
  cur_val = chksum_bios_get_value(  bios_data, offset );
  new_val = chksum_bios_calc_value( bios_data, offset );
  printf( "\n\nBios checksum at:   0x%4lX\n", offset  );
  printf( "Current checksum:     0x%02X\n",   cur_val );
  printf( "Calculated checksum:  0x%02X  ",   new_val );
  if( cur_val != new_val ) {
    printf( "Setting checksum." );
    chksum_bios_set_value( bios_data, offset, new_val );
  }
  printf( "\n" );
 
write_bios:
  if ((stream = fopen(argv[arg], "wb")) == NULL) {
    printf("Error opening %s for writing.\n", argv[arg]);
    exit(EXIT_FAILURE);
  }
  if (fwrite(bios_data, 1, LEN_BIOS_DATA, stream) < LEN_BIOS_DATA) {
    printf("Error writing 64KBytes to %s.\n", argv[arg]);
    fclose(stream);
    exit(EXIT_FAILURE);
  }
  fclose(stream);
 
  return(EXIT_SUCCESS);
}
 
 
void check(int okay, char* message) {
 
  if (!okay) {
    printf("\n\nError. %s.\n", message);
    exit(EXIT_FAILURE);
  }
}
 
 
long chksum_bios_get_offset( byte* data, long offset ) {
 
  return( BIOS_OFFSET );
}
 
 
byte chksum_bios_calc_value( byte* data, long offset ) {
 
  int   i;
  byte  sum;
 
  sum = 0;
  for( i = 0; i < MAX_OFFSET; i++ ) {
    sum = sum + *( data + i );
  }
  sum = -sum;          /* iso ensures -s + s == 0 on unsigned types */
  return( sum );
}
 
 
byte chksum_bios_get_value( byte* data, long offset ) {
 
  return( *( data + BIOS_OFFSET ) );
}
 
 
void chksum_bios_set_value( byte* data, long offset, byte value ) {
 
  *( data + BIOS_OFFSET ) = value;
}
 
 
byte chksum__32__calc_value( byte* data, long offset ) {
 
  int           i;
  int           len;
  byte sum;
 
  check( offset + _32__MINHDR <= MAX_OFFSET, "_32_ header out of bounds" );
  len = *( data + offset + _32__LEN ) << 4;
  check( offset + len <= MAX_OFFSET, "_32_ header-length out of bounds" );
  sum = 0;
  for( i = 0; i < len; i++ ) {
    if( i != _32__CHKSUM ) {
      sum = sum + *( data + offset + i );
    }
  }
  sum = -sum;
  return( sum );
}
 
 
long chksum__32__get_offset( byte* data, long offset ) {
 
  long result = -1L;
 
  offset = offset + 0x0F;
  offset = offset & ~( 0x0F );
  while( offset + 16 < MAX_OFFSET ) {
    offset = offset + 16;
    if( *( data + offset + 0 ) == '_' && \
        *( data + offset + 1 ) == '3' && \
        *( data + offset + 2 ) == '2' && \
        *( data + offset + 3 ) == '_' ) {
      result = offset;
      break;
    }
  }
  return( result );
}
 
 
byte chksum__32__get_value( byte* data, long offset ) {
 
  check( offset + _32__CHKSUM <= MAX_OFFSET, "PCI-Bios checksum out of bounds" );
  return(  *( data + offset + _32__CHKSUM ) );
}
 
 
void chksum__32__set_value( byte* data, long offset, byte value ) {
 
  check( offset + _32__CHKSUM <= MAX_OFFSET, "PCI-Bios checksum out of bounds" );
  *( data + offset + _32__CHKSUM ) = value;
}
 
 
byte chksum__mp__calc_value( byte* data, long offset ) {
 
  int   i;
  int   len;
  byte  sum;
 
  check( offset + _MP__MINHDR <= MAX_OFFSET, "_MP_ header out of bounds" );
  len = *( data + offset + _MP__LEN ) << 4;
  check( offset + len <= MAX_OFFSET, "_MP_ header-length out of bounds" );
  sum = 0;
  for( i = 0; i < len; i++ ) {
    if( i != _MP__CHKSUM ) {
      sum = sum + *( data + offset + i );
    }
  }
  sum = -sum;
  return( sum );
}
 
 
long chksum__mp__get_offset( byte* data, long offset ) {
 
  long result = -1L;
 
  offset = offset + 0x0F;
  offset = offset & ~( 0x0F );
  while( offset + 16 < MAX_OFFSET ) {
    offset = offset + 16;
    if( *( data + offset + 0 ) == '_' && \
        *( data + offset + 1 ) == 'M' && \
        *( data + offset + 2 ) == 'P' && \
        *( data + offset + 3 ) == '_' ) {
      result = offset;
      break;
    }
  }
  return( result );
}
 
 
byte chksum__mp__get_value( byte* data, long offset ) {
 
  check( offset + _MP__CHKSUM <= MAX_OFFSET, "MP checksum out of bounds" );
  return( *( data + offset + _MP__CHKSUM ) );
}
 
 
void chksum__mp__set_value( byte* data, long offset, byte value ) {
 
  check( offset + _MP__CHKSUM <= MAX_OFFSET, "MP checksum out of bounds" );
  *( data + offset + _MP__CHKSUM ) = value;
}
 
 
byte chksum_pcmp_calc_value( byte* data, long offset ) {
 
  int   i;
  int   len;
  byte  sum;
 
  check( offset + PCMP_MINHDR <= MAX_OFFSET, "PCMP header out of bounds" );
  len  =   *( data + offset + PCMP_BASELEN )      + \
         ( *( data + offset + PCMP_BASELEN + 1 ) << 8 );
  check( offset + len <= MAX_OFFSET, "PCMP header-length out of bounds" );
  if( *( data + offset + PCMP_EXT_LEN )     | \
      *( data + offset + PCMP_EXT_LEN + 1 ) | \
      *( data + offset + PCMP_EXT_CHKSUM ) ) {
    check( 0, "PCMP header indicates extended tables (unsupported)" );
  }
  sum = 0;
  for( i = 0; i < len; i++ ) {
    if( i != PCMP_CHKSUM ) {
      sum = sum + *( data + offset + i );
    }
  }
  sum = -sum;
  return( sum );
}
 
 
long chksum_pcmp_get_offset( byte* data, long offset ) {
 
  long result = -1L;
 
  offset = offset + 0x0F;
  offset = offset & ~( 0x0F );
  while( offset + 16 < MAX_OFFSET ) {
    offset = offset + 16;
    if( *( data + offset + 0 ) == 'P' && \
        *( data + offset + 1 ) == 'C' && \
        *( data + offset + 2 ) == 'M' && \
        *( data + offset + 3 ) == 'P' ) {
      result = offset;
      break;
    }
  }
  return( result );
}
 
 
byte chksum_pcmp_get_value( byte* data, long offset ) {
 
  check( offset + PCMP_CHKSUM <= MAX_OFFSET, "PCMP checksum out of bounds" );
  return( *( data + offset + PCMP_CHKSUM ) );
}
 
 
void chksum_pcmp_set_value( byte* data, long offset, byte value ) {
 
  check( offset + PCMP_CHKSUM <= MAX_OFFSET, "PCMP checksum out of bounds" );
  *( data + offset + PCMP_CHKSUM ) = value;
}
 
 
byte chksum__pir_calc_value( byte* data, long offset ) {
 
  int   i;
  int   len;
  byte  sum;
 
  check( offset + _PIR_MINHDR <= MAX_OFFSET, "$PIR header out of bounds" );
  len  =   *( data + offset + _PIR_LEN )      + \
         ( *( data + offset + _PIR_LEN + 1 ) << 8 );
  check( offset + len <= MAX_OFFSET, "$PIR header-length out of bounds" );
  sum = 0;
  for( i = 0; i < len; i++ ) {
    if( i != _PIR_CHKSUM ) {
      sum = sum + *( data + offset + i );
    }
  }
  sum = -sum;
  return( sum );
}
 
 
long chksum__pir_get_offset( byte* data, long offset ) {
 
  long result = -1L;
 
  offset = offset + 0x0F;
  offset = offset & ~( 0x0F );
  while( offset + 16 < MAX_OFFSET ) {
    offset = offset + 16;
    if( *( data + offset + 0 ) == '$' && \
        *( data + offset + 1 ) == 'P' && \
        *( data + offset + 2 ) == 'I' && \
        *( data + offset + 3 ) == 'R' ) {
      result = offset;
      break;
    }
  }
  return( result );
}
 
 
byte chksum__pir_get_value( byte* data, long offset ) {
 
  check( offset + _PIR_CHKSUM <= MAX_OFFSET, "$PIR checksum out of bounds" );
  return(  *( data + offset + _PIR_CHKSUM ) );
}
 
 
void chksum__pir_set_value( byte* data, long offset, byte value ) {
 
  check( offset + _PIR_CHKSUM <= MAX_OFFSET, "$PIR checksum out of bounds" );
  *( data + offset + _PIR_CHKSUM ) = value;
}
 

Browse

Tools

Subversion Repositories zet86

[/] [zet86/] [trunk/] [soc/] [bios/] [biossums.c] - Blame information for rev 52

Line No.	Rev	Author	Line
1	26	zeus	`/*`
2	52	zeus	`* $Id: biossums.c,v 1.4 2007/05/28 08:09:13 vruppert Exp $`
3	26	zeus	`*`
4			`* This library is free software; you can redistribute it and/or`
5			`* modify it under the terms of the GNU Lesser General Public`
6			`* License as published by the Free Software Foundation; either`
7			`* version 2 of the License, or (at your option) any later version.`
8			`*`
9			`* This library is distributed in the hope that it will be useful,`
10			`* but WITHOUT ANY WARRANTY; without even the implied warranty of`
11			`* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU`
12			`* Lesser General Public License for more details.`
13			`*`
14			`* You should have received a copy of the GNU Lesser General Public`
15			`* License along with this library; if not, write to the Free Software`
16			`* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA`
17			`*/`
18
19			`/* biossums.c --- written by Eike W. for the Bochs BIOS */`
20
21			`#include <stdlib.h>`
22			`#include <stdio.h>`
23			`#include <string.h>`
24
25			`typedef unsigned char byte;`
26
27			`void check( int value, char* message );`
28
29			`#define LEN_BIOS_DATA 0x10000`
30			`#define MAX_OFFSET (LEN_BIOS_DATA - 1)`
31
32
33			`#define BIOS_OFFSET 0xFFFF`
34
35			`long chksum_bios_get_offset( byte* data, long offset );`
36			`byte chksum_bios_calc_value( byte* data, long offset );`
37			`byte chksum_bios_get_value( byte* data, long offset );`
38			`void chksum_bios_set_value( byte* data, long offset, byte value );`
39
40
41			`#define _32__LEN 9`
42			`#define _32__CHKSUM 10`
43
44			`#define _32__MINHDR 16`
45
46			`long chksum__32__get_offset( byte* data, long offset );`
47			`byte chksum__32__calc_value( byte* data, long offset );`
48			`byte chksum__32__get_value( byte* data, long offset );`
49			`void chksum__32__set_value( byte* data, long offset, byte value );`
50
51
52			`#define _MP__LEN 8`
53			`#define _MP__CHKSUM 10`
54
55			`#define _MP__MINHDR 16`
56
57			`long chksum__mp__get_offset( byte* data, long offset );`
58			`byte chksum__mp__calc_value( byte* data, long offset );`
59			`byte chksum__mp__get_value( byte* data, long offset );`
60			`void chksum__mp__set_value( byte* data, long offset, byte value );`
61
62
63			`#define PCMP_BASELEN 4`
64			`#define PCMP_CHKSUM 7`
65			`#define PCMP_EXT_LEN 40`
66			`#define PCMP_EXT_CHKSUM 42`
67
68			`#define PCMP_MINHDR 42`
69
70			`long chksum_pcmp_get_offset( byte* data, long offset );`
71			`byte chksum_pcmp_calc_value( byte* data, long offset );`
72			`byte chksum_pcmp_get_value( byte* data, long offset );`
73			`void chksum_pcmp_set_value( byte* data, long offset, byte value );`
74
75
76			`#define _PIR_LEN 6`
77			`#define _PIR_CHKSUM 31`
78
79			`#define _PIR_MINHDR 32`
80
81			`long chksum__pir_get_offset( byte *data, long offset );`
82			`byte chksum__pir_calc_value( byte* data, long offset );`
83			`byte chksum__pir_get_value( byte* data, long offset );`
84			`void chksum__pir_set_value( byte* data, long offset, byte value );`
85
86
87			`byte bios_data[LEN_BIOS_DATA];`
88			`long bios_len;`
89
90
91			`int main(int argc, char* argv[]) {`
92
93			`FILE* stream;`
94			`long offset, tmp_offset;`
95			`byte cur_val = 0, new_val = 0;`
96			`int arg = 1, hits, pad = 0;`
97
98
99			`if ((argc == 3) && (!strcmp(argv[1], "-pad"))) {`
100			`pad = 1;`
101			`arg = 2;`
102			`} else if (argc != 2) {`
103			`printf("Error. Need a file-name as an argument.\n");`
104			`exit(EXIT_FAILURE);`
105			`}`
106			`memset(bios_data, 0xff, LEN_BIOS_DATA);`
107
108			`if ((stream = fopen(argv[arg], "rb")) == NULL) {`
109			`printf("Error opening %s for reading.\n", argv[arg]);`
110			`exit(EXIT_FAILURE);`
111			`}`
112			`bios_len = fread(bios_data, 1, LEN_BIOS_DATA, stream);`
113			`if ((bios_len < LEN_BIOS_DATA) && (pad == 0)) {`
114			`printf("Error reading 64KBytes from %s.\n", argv[arg]);`
115			`fclose(stream);`
116			`exit(EXIT_FAILURE);`
117			`}`
118			`fclose(stream);`
119			`if (pad == 1) goto write_bios;`
120
121			`hits = 0;`
122			`offset = 0L;`
123			`while( (tmp_offset = chksum__32__get_offset( bios_data, offset )) != -1L ) {`
124			`offset = tmp_offset;`
125			`cur_val = chksum__32__get_value( bios_data, offset );`
126			`new_val = chksum__32__calc_value( bios_data, offset );`
127			`printf( "\n\nPCI-Bios header at: 0x%4lX\n", offset );`
128			`printf( "Current checksum: 0x%02X\n", cur_val );`
129			`printf( "Calculated checksum: 0x%02X ", new_val );`
130			`hits++;`
131			`}`
132			`if( hits == 1 && cur_val != new_val ) {`
133			`printf( "Setting checksum." );`
134			`chksum__32__set_value( bios_data, offset, new_val );`
135			`}`
136			`if( hits >= 2 ) {`
137			`printf( "Multiple PCI headers! No checksum set." );`
138			`}`
139			`if( hits ) {`
140			`printf( "\n" );`
141			`}`
142
143
144			`hits = 0;`
145			`offset = 0L;`
146			`while( (tmp_offset = chksum__mp__get_offset( bios_data, offset )) != -1L ) {`
147			`offset = tmp_offset;`
148			`cur_val = chksum__mp__get_value( bios_data, offset );`
149			`new_val = chksum__mp__calc_value( bios_data, offset );`
150			`printf( "\n\nMP header at: 0x%4lX\n", offset );`
151			`printf( "Current checksum: 0x%02X\n", cur_val );`
152			`printf( "Calculated checksum: 0x%02X ", new_val );`
153			`hits++;`
154			`}`
155			`if( hits == 1 && cur_val != new_val ) {`
156			`printf( "Setting checksum." );`
157			`chksum__mp__set_value( bios_data, offset, new_val );`
158			`}`
159			`if( hits >= 2 ) {`
160			`printf( "Warning! Multiple MP headers. No checksum set." );`
161			`}`
162			`if( hits ) {`
163			`printf( "\n" );`
164			`}`
165
166
167			`hits = 0;`
168			`offset = 0L;`
169			`while( (tmp_offset = chksum_pcmp_get_offset( bios_data, offset )) != -1L ) {`
170			`offset = tmp_offset;`
171			`cur_val = chksum_pcmp_get_value( bios_data, offset );`
172			`new_val = chksum_pcmp_calc_value( bios_data, offset );`
173			`printf( "\n\nPCMP header at: 0x%4lX\n", offset );`
174			`printf( "Current checksum: 0x%02X\n", cur_val );`
175			`printf( "Calculated checksum: 0x%02X ", new_val );`
176			`hits++;`
177			`}`
178			`if( hits == 1 && cur_val != new_val ) {`
179			`printf( "Setting checksum." );`
180			`chksum_pcmp_set_value( bios_data, offset, new_val );`
181			`}`
182			`if( hits >= 2 ) {`
183			`printf( "Warning! Multiple PCMP headers. No checksum set." );`
184			`}`
185			`if( hits ) {`
186			`printf( "\n" );`
187			`}`
188
189
190			`hits = 0;`
191			`offset = 0L;`
192			`while( (tmp_offset = chksum__pir_get_offset( bios_data, offset )) != -1L ) {`
193			`offset = tmp_offset;`
194			`cur_val = chksum__pir_get_value( bios_data, offset );`
195			`new_val = chksum__pir_calc_value( bios_data, offset );`
196			`printf( "\n\n$PIR header at: 0x%4lX\n", offset );`
197			`printf( "Current checksum: 0x%02X\n", cur_val );`
198			`printf( "Calculated checksum: 0x%02X\n ", new_val );`
199			`hits++;`
200			`}`
201			`if( hits == 1 && cur_val != new_val ) {`
202			`printf( "Setting checksum." );`
203			`chksum__pir_set_value( bios_data, offset, new_val );`
204			`}`
205			`if( hits >= 2 ) {`
206			`printf( "Warning! Multiple $PIR headers. No checksum set." );`
207			`}`
208			`if( hits ) {`
209			`printf( "\n" );`
210			`}`
211
212
213			`offset = 0L;`
214			`offset = chksum_bios_get_offset( bios_data, offset );`
215			`cur_val = chksum_bios_get_value( bios_data, offset );`
216			`new_val = chksum_bios_calc_value( bios_data, offset );`
217			`printf( "\n\nBios checksum at: 0x%4lX\n", offset );`
218			`printf( "Current checksum: 0x%02X\n", cur_val );`
219			`printf( "Calculated checksum: 0x%02X ", new_val );`
220			`if( cur_val != new_val ) {`
221			`printf( "Setting checksum." );`
222			`chksum_bios_set_value( bios_data, offset, new_val );`
223			`}`
224			`printf( "\n" );`
225
226			`write_bios:`
227			`if ((stream = fopen(argv[arg], "wb")) == NULL) {`
228			`printf("Error opening %s for writing.\n", argv[arg]);`
229			`exit(EXIT_FAILURE);`
230			`}`
231			`if (fwrite(bios_data, 1, LEN_BIOS_DATA, stream) < LEN_BIOS_DATA) {`
232			`printf("Error writing 64KBytes to %s.\n", argv[arg]);`
233			`fclose(stream);`
234			`exit(EXIT_FAILURE);`
235			`}`
236			`fclose(stream);`
237
238			`return(EXIT_SUCCESS);`
239			`}`
240
241
242			`void check(int okay, char* message) {`
243
244			`if (!okay) {`
245			`printf("\n\nError. %s.\n", message);`
246			`exit(EXIT_FAILURE);`
247			`}`
248			`}`
249
250
251			`long chksum_bios_get_offset( byte* data, long offset ) {`
252
253			`return( BIOS_OFFSET );`
254			`}`
255
256
257			`byte chksum_bios_calc_value( byte* data, long offset ) {`
258
259			`int i;`
260			`byte sum;`
261
262			`sum = 0;`
263			`for( i = 0; i < MAX_OFFSET; i++ ) {`
264			`sum = sum + *( data + i );`
265			`}`
266			`sum = -sum; /* iso ensures -s + s == 0 on unsigned types */`
267			`return( sum );`
268			`}`
269
270
271			`byte chksum_bios_get_value( byte* data, long offset ) {`
272
273			`return( *( data + BIOS_OFFSET ) );`
274			`}`
275
276
277			`void chksum_bios_set_value( byte* data, long offset, byte value ) {`
278
279			`*( data + BIOS_OFFSET ) = value;`
280			`}`
281
282
283			`byte chksum__32__calc_value( byte* data, long offset ) {`
284
285			`int i;`
286			`int len;`
287			`byte sum;`
288
289			`check( offset + _32__MINHDR <= MAX_OFFSET, "_32_ header out of bounds" );`
290			`len = *( data + offset + _32__LEN ) << 4;`
291			`check( offset + len <= MAX_OFFSET, "_32_ header-length out of bounds" );`
292			`sum = 0;`
293			`for( i = 0; i < len; i++ ) {`
294			`if( i != _32__CHKSUM ) {`
295			`sum = sum + *( data + offset + i );`
296			`}`
297			`}`
298			`sum = -sum;`
299			`return( sum );`
300			`}`
301
302
303			`long chksum__32__get_offset( byte* data, long offset ) {`
304
305			`long result = -1L;`
306
307			`offset = offset + 0x0F;`
308			`offset = offset & ~( 0x0F );`
309			`while( offset + 16 < MAX_OFFSET ) {`
310			`offset = offset + 16;`
311			`if( *( data + offset + 0 ) == '_' && \`
312			`*( data + offset + 1 ) == '3' && \`
313			`*( data + offset + 2 ) == '2' && \`
314			`*( data + offset + 3 ) == '_' ) {`
315			`result = offset;`
316			`break;`
317			`}`
318			`}`
319			`return( result );`
320			`}`
321
322
323			`byte chksum__32__get_value( byte* data, long offset ) {`
324
325			`check( offset + _32__CHKSUM <= MAX_OFFSET, "PCI-Bios checksum out of bounds" );`
326			`return( *( data + offset + _32__CHKSUM ) );`
327			`}`
328
329
330			`void chksum__32__set_value( byte* data, long offset, byte value ) {`
331
332			`check( offset + _32__CHKSUM <= MAX_OFFSET, "PCI-Bios checksum out of bounds" );`
333			`*( data + offset + _32__CHKSUM ) = value;`
334			`}`
335
336
337			`byte chksum__mp__calc_value( byte* data, long offset ) {`
338
339			`int i;`
340			`int len;`
341			`byte sum;`
342
343			`check( offset + _MP__MINHDR <= MAX_OFFSET, "_MP_ header out of bounds" );`
344			`len = *( data + offset + _MP__LEN ) << 4;`
345			`check( offset + len <= MAX_OFFSET, "_MP_ header-length out of bounds" );`
346			`sum = 0;`
347			`for( i = 0; i < len; i++ ) {`
348			`if( i != _MP__CHKSUM ) {`
349			`sum = sum + *( data + offset + i );`
350			`}`
351			`}`
352			`sum = -sum;`
353			`return( sum );`
354			`}`
355
356
357			`long chksum__mp__get_offset( byte* data, long offset ) {`
358
359			`long result = -1L;`
360
361			`offset = offset + 0x0F;`
362			`offset = offset & ~( 0x0F );`
363			`while( offset + 16 < MAX_OFFSET ) {`
364			`offset = offset + 16;`
365			`if( *( data + offset + 0 ) == '_' && \`
366			`*( data + offset + 1 ) == 'M' && \`
367			`*( data + offset + 2 ) == 'P' && \`
368			`*( data + offset + 3 ) == '_' ) {`
369			`result = offset;`
370			`break;`
371			`}`
372			`}`
373			`return( result );`
374			`}`
375
376
377			`byte chksum__mp__get_value( byte* data, long offset ) {`
378
379			`check( offset + _MP__CHKSUM <= MAX_OFFSET, "MP checksum out of bounds" );`
380			`return( *( data + offset + _MP__CHKSUM ) );`
381			`}`
382
383
384			`void chksum__mp__set_value( byte* data, long offset, byte value ) {`
385
386			`check( offset + _MP__CHKSUM <= MAX_OFFSET, "MP checksum out of bounds" );`
387			`*( data + offset + _MP__CHKSUM ) = value;`
388			`}`
389
390
391			`byte chksum_pcmp_calc_value( byte* data, long offset ) {`
392
393			`int i;`
394			`int len;`
395			`byte sum;`
396
397			`check( offset + PCMP_MINHDR <= MAX_OFFSET, "PCMP header out of bounds" );`
398			`len = *( data + offset + PCMP_BASELEN ) + \`
399			`( *( data + offset + PCMP_BASELEN + 1 ) << 8 );`
400			`check( offset + len <= MAX_OFFSET, "PCMP header-length out of bounds" );`
401			`if( *( data + offset + PCMP_EXT_LEN ) \| \`
402			`*( data + offset + PCMP_EXT_LEN + 1 ) \| \`
403			`*( data + offset + PCMP_EXT_CHKSUM ) ) {`
404			`check( 0, "PCMP header indicates extended tables (unsupported)" );`
405			`}`
406			`sum = 0;`
407			`for( i = 0; i < len; i++ ) {`
408			`if( i != PCMP_CHKSUM ) {`
409			`sum = sum + *( data + offset + i );`
410			`}`
411			`}`
412			`sum = -sum;`
413			`return( sum );`
414			`}`
415
416
417			`long chksum_pcmp_get_offset( byte* data, long offset ) {`
418
419			`long result = -1L;`
420
421			`offset = offset + 0x0F;`
422			`offset = offset & ~( 0x0F );`
423			`while( offset + 16 < MAX_OFFSET ) {`
424			`offset = offset + 16;`
425			`if( *( data + offset + 0 ) == 'P' && \`
426			`*( data + offset + 1 ) == 'C' && \`
427			`*( data + offset + 2 ) == 'M' && \`
428			`*( data + offset + 3 ) == 'P' ) {`
429			`result = offset;`
430			`break;`
431			`}`
432			`}`
433			`return( result );`
434			`}`
435
436
437			`byte chksum_pcmp_get_value( byte* data, long offset ) {`
438
439			`check( offset + PCMP_CHKSUM <= MAX_OFFSET, "PCMP checksum out of bounds" );`
440			`return( *( data + offset + PCMP_CHKSUM ) );`
441			`}`
442
443
444			`void chksum_pcmp_set_value( byte* data, long offset, byte value ) {`
445
446			`check( offset + PCMP_CHKSUM <= MAX_OFFSET, "PCMP checksum out of bounds" );`
447			`*( data + offset + PCMP_CHKSUM ) = value;`
448			`}`
449
450
451			`byte chksum__pir_calc_value( byte* data, long offset ) {`
452
453			`int i;`
454			`int len;`
455			`byte sum;`
456
457			`check( offset + _PIR_MINHDR <= MAX_OFFSET, "$PIR header out of bounds" );`
458			`len = *( data + offset + _PIR_LEN ) + \`
459			`( *( data + offset + _PIR_LEN + 1 ) << 8 );`
460			`check( offset + len <= MAX_OFFSET, "$PIR header-length out of bounds" );`
461			`sum = 0;`
462			`for( i = 0; i < len; i++ ) {`
463			`if( i != _PIR_CHKSUM ) {`
464			`sum = sum + *( data + offset + i );`
465			`}`
466			`}`
467			`sum = -sum;`
468			`return( sum );`
469			`}`
470
471
472			`long chksum__pir_get_offset( byte* data, long offset ) {`
473
474			`long result = -1L;`
475
476			`offset = offset + 0x0F;`
477			`offset = offset & ~( 0x0F );`
478			`while( offset + 16 < MAX_OFFSET ) {`
479			`offset = offset + 16;`
480			`if( *( data + offset + 0 ) == '$' && \`
481			`*( data + offset + 1 ) == 'P' && \`
482			`*( data + offset + 2 ) == 'I' && \`
483			`*( data + offset + 3 ) == 'R' ) {`
484			`result = offset;`
485			`break;`
486			`}`
487			`}`
488			`return( result );`
489			`}`
490
491
492			`byte chksum__pir_get_value( byte* data, long offset ) {`
493
494			`check( offset + _PIR_CHKSUM <= MAX_OFFSET, "$PIR checksum out of bounds" );`
495			`return( *( data + offset + _PIR_CHKSUM ) );`
496			`}`
497
498
499			`void chksum__pir_set_value( byte* data, long offset, byte value ) {`
500
501			`check( offset + _PIR_CHKSUM <= MAX_OFFSET, "$PIR checksum out of bounds" );`
502			`*( data + offset + _PIR_CHKSUM ) = value;`
503			`}`
504