Initial commit of OpenSPARC T2 architecture model.

[OpenSPARC-T2-SAM] / obp / tools / gen-seeprom / common.c

/*
* ========== Copyright Header Begin ==========================================
*
* Hypervisor Software File: common.c
* 
* Copyright (c) 2006 Sun Microsystems, Inc. All Rights Reserved.
* 
*  - Do no alter or remove copyright notices
* 
*  - Redistribution and use of this software in source and binary forms, with 
*    or without modification, are permitted provided that the following 
*    conditions are met: 
* 
*  - Redistribution of source code must retain the above copyright notice, 
*    this list of conditions and the following disclaimer.
* 
*  - Redistribution in binary form must reproduce the above copyright notice,
*    this list of conditions and the following disclaimer in the
*    documentation and/or other materials provided with the distribution. 
* 
*    Neither the name of Sun Microsystems, Inc. or the names of contributors 
* may be used to endorse or promote products derived from this software 
* without specific prior written permission. 
* 
*     This software is provided "AS IS," without a warranty of any kind. 
* ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND WARRANTIES, 
* INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY, FITNESS FOR A 
* PARTICULAR PURPOSE OR NON-INFRINGEMENT, ARE HEREBY EXCLUDED. SUN 
* MICROSYSTEMS, INC. ("SUN") AND ITS LICENSORS SHALL NOT BE LIABLE FOR 
* ANY DAMAGES SUFFERED BY LICENSEE AS A RESULT OF USING, MODIFYING OR 
* DISTRIBUTING THIS SOFTWARE OR ITS DERIVATIVES. IN NO EVENT WILL SUN 
* OR ITS LICENSORS BE LIABLE FOR ANY LOST REVENUE, PROFIT OR DATA, OR 
* FOR DIRECT, INDIRECT, SPECIAL, CONSEQUENTIAL, INCIDENTAL OR PUNITIVE 
* DAMAGES, HOWEVER CAUSED AND REGARDLESS OF THE THEORY OF LIABILITY, 
* ARISING OUT OF THE USE OF OR INABILITY TO USE THIS SOFTWARE, EVEN IF 
* SUN HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGES.
* 
* You acknowledge that this software is not designed, licensed or
* intended for use in the design, construction, operation or maintenance of
* any nuclear facility. 
* 
* ========== Copyright Header End ============================================
*/
/*
 * id: @(#)common.c 1.2 02/01/24
 * purpose:
 * copyright: Copyright 2000-2002 Sun Microsystems, Inc.  All Rights Reserved
 * copyright: Use is subject to license terms.
 */

#include <stdio.h>
#include <stdlib.h>
#include <strings.h>
#include "gen-seeprom.h"
#include "prototypes.h"

union data_format {
	unsigned char str[8];
	unsigned long long value;
};

/*
 * scan decimal or hex value in from a line of input
 */


void
strip_val(char *input_str, unsigned int *input_val)
{
	if ((strncmp(input_str, "0x", 2) == 0) ||
	    (strncmp(input_str, "0X", 2) == 0)) {
		sscanf(&input_str[2], "%x", input_val);
	} else {
		sscanf(&input_str[0], "%d", input_val);
	}
}

int
scan_line(char *line, unsigned int *input_val)
{
	char temp[MAXNAMESIZE];
	char input_str[MAXNAMESIZE];

	if (sscanf(line, "%32s %32s", temp, input_str) != 2) {
		return (ERROR);
	}
	strip_val(input_str, input_val);
	return (NO_ERROR);
}


/*
 * convert an integer value into a byte string and assign it to data_ptr
 * at the given offset
 */

void
write_bytes(unsigned int input_val, int size, int offset,
    unsigned char *data_ptr)
{
	unsigned char byte;

	while (size) {
		byte = input_val >> ((size-1)*8);
		byte &= 0xff;
		data_ptr[offset++] = byte;
		size--;
	}
}

void
store_chars(int len, unsigned char *string, unsigned char **ptr)
{
	union data_format data;

	while (len > 0) {
		if (len > 8) {
			memcpy(data.str, string, 8);
			store_bytes(8, data.value, ptr);
			len -= 8;
			string += 8;
		} else {
			memcpy(data.str, string, len);
			data.value >>= (8-len)*8;
			store_bytes(len, data.value, ptr);
			len = 0;
		}
	}
}

/* Internet checksum */
unsigned short
checksum(unsigned short *addr, int count)
{
	int sum = 0;
	while (count > 1) {
		sum += *addr++;
		count -= 2;
	}

	if (count > 0)
		sum += *(unsigned char *) addr;

	while (sum >> 16) {
		sum = (sum & 0xffff) + (sum >> 16);
	}

	sum = (~sum) & 0xffff;
	if (sum == 0)
		sum = 0xffff;
	return (sum);
}