csu3_am335x/EVSE/GPL/plc-utils.LNX.2.1.20/source/pib/psout.c

/*====================================================================*
*
*   Copyright (c) 2013 Qualcomm Atheros, Inc.
*
*   All rights reserved.
*
*====================================================================*/

/*====================================================================*
 *
 *   psout.c - Export PIB Prescalers;
 *
 *   Contributor(s):
 *	Charles Maier <cmaier@qca.qualcomm.com>
 *
 *--------------------------------------------------------------------*/

/*====================================================================*
 *   system header files;
 *--------------------------------------------------------------------*/

#include <math.h>
#include <stdio.h>
#include <string.h>
#include <unistd.h>
#include <errno.h>
#include <sys/stat.h>

/*====================================================================*
 *   custom header files;
 *--------------------------------------------------------------------*/

#include "../tools/getoptv.h"
#include "../tools/number.h"
#include "../tools/chars.h"
#include "../tools/types.h"
#include "../tools/error.h"
#include "../tools/files.h"
#include "../tools/endian.h"
#include "../pib/pib.h"
#include "../plc/plc.h"

/*====================================================================*
 *   custom source files;
 *--------------------------------------------------------------------*/

#ifndef MAKEFILE
#include "../tools/getoptv.c"
#include "../tools/putoptv.c"
#include "../tools/version.c"
#include "../tools/fdchecksum32.c"
#include "../tools/error.c"
#endif

#ifndef MAKEFILE
#include "../pib/lightning_pib_file.c"
#include "../pib/pibscalers.c"
#endif

/*====================================================================*
 *   program constants;
 *--------------------------------------------------------------------*/

#define PSOUT_VERBOSE (1 << 0)
#define PSOUT_SILENCE (1 << 1)

/*====================================================================*
 *
 *   void ar7x00Prescalers (struct _file_ * pib);
 *
 *--------------------------------------------------------------------*/

static void ar7x00Prescalers (struct _file_ * pib) 

{ 

#if 0

	uint32_t value; 
	uint32_t temp; 
	uint32_t buffer = 0; 
	unsigned bits = 0; 
	unsigned index = 0; 
	if (lseek (pib->file, AMP_PRESCALER_OFFSET, SEEK_SET) != AMP_PRESCALER_OFFSET) 
	{ 
		error (1, errno, FILE_CANTSEEK, pib->name); 
	} 

/* no dependency on math lib */

	while (index < AMP_CARRIERS) 
	{ 
		if (read (pib->file, & temp, sizeof (temp)) != sizeof (temp)) 
		{ 
			error (1, errno, FILE_CANTREAD, pib->name); 
		} 
		temp = LE32TOH (temp); 
		buffer |= (temp << bits); 
		if (bits == 0) 
		{ 
			bits = 8 * sizeof (buffer); 
		} 
		else 
		{ 
			if (lseek (pib->file, - 1, SEEK_CUR) == - 1) 
			{ 
				error (1, errno, "could not seek backwards"); 
			} 
			bits += 8 * (sizeof (buffer) - 1); 
		} 
		while (bits >= 10) 
		{ 
			value = (buffer & 0x000003FF); 
			printf ("%08d %08X\n", index, value); 
			buffer = buffer >> 10; 
			++ index; 
			bits -= 10; 
		} 
	} 

#elif 0

	uint32_t value; 
	uint32_t temp; 
	uint32_t buffer = 0; 
	unsigned bits = 0; 
	unsigned index = 0; 
	if (lseek (pib->file, AMP_PRESCALER_OFFSET, SEEK_SET) != AMP_PRESCALER_OFFSET) 
	{ 
		error (1, errno, FILE_CANTSEEK, pib->name); 
	} 

/* more generic code, but requires math lib, add -lm to LFLAGS */

	while (index < AMP_CARRIERS) 
	{ 
		if (read (pib->file, & temp, sizeof (temp)) != sizeof (temp)) 
		{ 
			error (1, errno, FILE_CANTREAD, pib->name); 
		} 
		temp = LE32TOH (temp); 
		buffer |= (temp << bits); 
		if (lseek (pib->file, (off_t) (- ceil (bits / 8.0)), SEEK_CUR) == - 1) 
		{ 
			error (1, errno, "could not seek backwards"); 
		} 
		bits += 8 * (sizeof (buffer) - (unsigned) (ceil (bits / 8.0))); 
		while (bits >= 10) 
		{ 
			value = (buffer & 0x000003FF); 
			printf ("%08d %08X\n", index, value); 
			buffer = buffer >> 10; 
			++ index; 
			bits -= 10; 
		} 
	} 

#else

	uint16_t upper; 
	uint16_t lower; 
	unsigned index = 0; 
	byte buffer [AMP_PRESCALER_LENGTH]; 
	byte * p = buffer; 
	if (lseek (pib->file, AMP_PRESCALER_OFFSET, SEEK_SET) != AMP_PRESCALER_OFFSET) 
	{ 
		error (1, errno, FILE_CANTSEEK, pib->name); 
	} 
	if (read (pib->file, buffer, sizeof (buffer)) != sizeof (buffer)) 
	{ 
		error (1, errno, FILE_CANTREAD, pib->name); 
	} 

/*
 * |00000000|00111111|11112222|22222233|33333333|
 * |01234567|89012345|67890123|45678901|23456789|
 */

	while (index < AMP_CARRIERS) 
	{ 
		lower = (* p++ & 0xFF) >> 0; 
		upper = (* p & 0x03) << 8; 
		printf ("%08d %08X\n", index++, upper | lower); 
		lower = (* p++ & 0xFC) >> 2; 
		upper = (* p & 0x0F) << 6; 
		printf ("%08d %08X\n", index++, upper | lower); 
		lower = (* p++ & 0xF0) >> 4; 
		upper = (* p & 0x3F) << 4; 
		printf ("%08d %08X\n", index++, upper | lower); 
		lower = (* p++ & 0xC0) >> 6; 
		upper = (* p++ & 0xFF) << 2; 
		printf ("%08d %08X\n", index++, upper | lower); 
	} 

#endif

	return; 
} 

/*====================================================================*
 *
 *   void int6x00Prescalers (struct _file_ * pib);
 *
 *--------------------------------------------------------------------*/

static void int6x00Prescalers (struct _file_ * pib) 

{ 
	unsigned index = 0; 
	if (lseek (pib->file, INT_PRESCALER_OFFSET, SEEK_SET) != INT_PRESCALER_OFFSET) 
	{ 
		error (1, errno, FILE_CANTSEEK, pib->name); 
	} 
	while (index < INT_CARRIERS) 
	{ 
		uint32_t value; 
		if (read (pib->file, & value, sizeof (value)) != sizeof (value)) 
		{ 
			error (1, errno, FILE_CANTREAD, pib->name); 
		} 
		printf ("%08d %08X\n", index++, LE32TOH (value)); 
	} 
	return; 
} 

/*====================================================================*
 *   
 *   int main (int argc, char const * argv []) 
 *   
 *
 *--------------------------------------------------------------------*/

int main (int argc, char const * argv []) 

{ 
	static char const * optv [] = 
	{ 
		"", 
		"pibfile [> scalers]", 
		"Export PIB Prescalers", 
		(char const *) (0)
	}; 
	struct _file_ pib; 
	unsigned scalers; 
	signed c; 
	optind = 1; 
	while (~ (c = getoptv (argc, argv, optv))) 
	{ 
		switch ((char) (c)) 
		{ 
		default: 
			break; 
		} 
	} 
	argc -= optind; 
	argv += optind; 
	if (argc > 1) 
	{ 
		error (1, ENOTSUP, "Only one file is permitted"); 
	} 
	if ((argc) && (* argv)) 
	{ 
		pib.name = * argv; 
		if ((pib.file = open (pib.name, O_BINARY | O_RDONLY)) == - 1) 
		{ 
			error (1, errno, "Can't open %s", pib.name); 
		} 
		if (lightning_pib_file (& pib)) 
		{ 
			error (1, errno, "Bad PIB file: %s", pib.name); 
		} 
		scalers = pibscalers (& pib); 
		if (scalers == AMP_CARRIERS) 
		{ 
			ar7x00Prescalers (& pib); 
		} 
		else if (scalers == INT_CARRIERS) 
		{ 
			int6x00Prescalers (& pib); 
		} 
		else 
		{ 
			error (1, ENOTSUP, "Unexpected number of carriers"); 
		} 
		close (pib.file); 
	} 
	return (0); 
}