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

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

/*====================================================================*
 *
 *   signed lightning_pib_peek (void const * memory);
 *
 *   pib.h
 *
 *   print PIB identity information on stdout; 
 *
 *   Contributor(s):
 *	Charles Maier <cmaier@qca.qualcomm.com>
 *
 *--------------------------------------------------------------------*/

#ifndef LIGHTNING_PIB_PEEK_SOURCE
#define LIGHTNING_PIB_PEEK_SOURCE

#include <stdio.h>
#include <memory.h>

#include "../tools/memory.h"
#include "../tools/number.h"
#include "../key/HPAVKey.h"
#include "../key/keys.h"
#include "../pib/pib.h"

static char const * CCoMode [] = 

{ 
	"Auto", 
	"Never", 
	"Always", 
	"User", 
	"Covert", 
	"Unknown"
}; 

static char const * MDURole [] = 

{ 
	"Slave", 
	"Master"
}; 

signed lightning_pib_peek (void const * memory) 

{ 
	extern const struct key keys [KEYS]; 
	struct PIB1 * PIB = (struct PIB1 *) (memory); 
	char buffer [HPAVKEY_SHA_LEN * 3]; 
	size_t key; 
	if (PIB->FWVersion == 1) 
	{ 
		if (PIB->PIBVersion == 2) 
		{ 
			struct PIB1_2 * PIB = (struct PIB1_2 *) (memory); 
			printf ("\tPIB %d-%d\n", PIB->FWVersion, PIB->PIBVersion); 
			printf ("\tMAC %s\n", hexstring (buffer, sizeof (buffer), PIB->MAC, sizeof (PIB->MAC))); 
			printf ("\tDAK %s", hexstring (buffer, sizeof (buffer), PIB->DAK, sizeof (PIB->DAK))); 
			for (key = 0; key < KEYS; key++) 
			{ 
				if (! memcmp (keys [key].DAK, PIB->DAK, HPAVKEY_DAK_LEN)) 
				{ 
					printf (" (%s)", keys [key].phrase); 
					break; 
				} 
			} 
			printf ("\n"); 
			printf ("\tNMK %s", hexstring (buffer, sizeof (buffer), PIB->NMK, sizeof (PIB->NMK))); 
			for (key = 0; key < KEYS; key++) 
			{ 
				if (! memcmp (keys [key].NMK, PIB->NMK, HPAVKEY_NMK_LEN)) 
				{ 
					printf (" (%s)", keys [key].phrase); 
					break; 
				} 
			} 
			printf ("\n"); 
			printf ("\tFLG %s\n", hexstring (buffer, sizeof (buffer), (uint8_t *) (& PIB->FLG), sizeof (PIB->FLG))); 
			return (0); 
		} 
		else if (PIB->PIBVersion == 3) 
		{ 
			struct PIB1_3 * PIB = (struct PIB1_3 *) (memory); 
			printf ("\tPIB %d-%d\n", PIB->FWVersion, PIB->PIBVersion); 
			printf ("\tMAC %s\n", hexstring (buffer, sizeof (buffer), PIB->MAC, sizeof (PIB->MAC))); 
			printf ("\tDAK %s", hexstring (buffer, sizeof (buffer), PIB->DAK, sizeof (PIB->DAK))); 
			for (key = 0; key < KEYS; key++) 
			{ 
				if (! memcmp (keys [key].DAK, PIB->DAK, HPAVKEY_DAK_LEN)) 
				{ 
					printf (" (%s)", keys [key].phrase); 
					break; 
				} 
			} 
			printf ("\n"); 
			printf ("\tNMK %s", hexstring (buffer, sizeof (buffer), PIB->NMK, sizeof (PIB->NMK))); 
			for (key = 0; key < KEYS; key++) 
			{ 
				if (! memcmp (keys [key].NMK, PIB->NMK, HPAVKEY_NMK_LEN)) 
				{ 
					printf (" (%s)", keys [key].phrase); 
					break; 
				} 
			} 
			printf ("\n"); 
			printf ("\tNET \"%s\"\n", PIB->NET); 
			printf ("\tMFG \"%s\"\n", PIB->MFG); 
			printf ("\tUSR \"%s\"\n", PIB->USR); 
			return (0); 
		} 
		else if (PIB->PIBVersion >= 4) 
		{ 
			struct PIB1_4 * PIB = (struct PIB1_4 *) (memory); 
			printf ("\tPIB %d-%d %d bytes\n", PIB->VersionHeader.FWVersion, PIB->VersionHeader.PIBVersion, LE16TOH (PIB->VersionHeader.PIBLength)); 
			printf ("\tMAC %s\n", hexstring (buffer, sizeof (buffer), PIB->LocalDeviceConfig.MAC, sizeof (PIB->LocalDeviceConfig.MAC))); 
			printf ("\tDAK %s", hexstring (buffer, sizeof (buffer), PIB->LocalDeviceConfig.DAK, sizeof (PIB->LocalDeviceConfig.DAK))); 
			for (key = 0; key < KEYS; key++) 
			{ 
				if (! memcmp (keys [key].DAK, PIB->LocalDeviceConfig.DAK, HPAVKEY_DAK_LEN)) 
				{ 
					printf (" (%s)", keys [key].phrase); 
					break; 
				} 
			} 
			printf ("\n"); 
			printf ("\tNMK %s", hexstring (buffer, sizeof (buffer), PIB->LocalDeviceConfig.NMK, sizeof (PIB->LocalDeviceConfig.NMK))); 
			for (key = 0; key < KEYS; key++) 
			{ 
				if (! memcmp (keys [key].NMK, PIB->LocalDeviceConfig.NMK, HPAVKEY_NMK_LEN)) 
				{ 
					printf (" (%s)", keys [key].phrase); 
					break; 
				} 
			} 
			printf ("\n"); 
			printf ("\tNET %s\n", PIB->LocalDeviceConfig.NET); 
			printf ("\tMFG %s\n", PIB->LocalDeviceConfig.MFG); 
			printf ("\tUSR %s\n", PIB->LocalDeviceConfig.USR); 
			return (0); 
		} 
	} 
	else if (PIB->FWVersion == 2) 
	{ 
		struct PIB2_0 * PIB = (struct PIB2_0 *) (memory); 
		printf ("\tPIB %d-%d %d bytes\n", PIB->VersionHeader.FWVersion, PIB->VersionHeader.PIBVersion, LE16TOH (PIB->VersionHeader.PIBLength)); 
		printf ("\tMAC %s\n", hexstring (buffer, sizeof (buffer), PIB->LocalDeviceConfig.MAC, sizeof (PIB->LocalDeviceConfig.MAC))); 
		printf ("\tDAK %s", hexstring (buffer, sizeof (buffer), PIB->LocalDeviceConfig.DAK, sizeof (PIB->LocalDeviceConfig.DAK))); 
		for (key = 0; key < KEYS; key++) 
		{ 
			if (! memcmp (keys [key].DAK, PIB->LocalDeviceConfig.DAK, HPAVKEY_DAK_LEN)) 
			{ 
				printf (" (%s)", keys [key].phrase); 
				break; 
			} 
		} 
		printf ("\n"); 
		printf ("\tNMK %s", hexstring (buffer, sizeof (buffer), PIB->LocalDeviceConfig.NMK, sizeof (PIB->LocalDeviceConfig.NMK))); 
		for (key = 0; key < KEYS; key++) 
		{ 
			if (! memcmp (keys [key].NMK, PIB->LocalDeviceConfig.NMK, HPAVKEY_NMK_LEN)) 
			{ 
				printf (" (%s)", keys [key].phrase); 
				break; 
			} 
		} 
		printf ("\n"); 
		printf ("\tNID %s\n", hexstring (buffer, sizeof (buffer), PIB->LocalDeviceConfig.PreferredNID, sizeof (PIB->LocalDeviceConfig.PreferredNID))); 
		printf ("\tNET %s\n", PIB->LocalDeviceConfig.NET); 
		printf ("\tMFG %s\n", PIB->LocalDeviceConfig.MFG); 
		printf ("\tUSR %s\n", PIB->LocalDeviceConfig.USR); 
		return (0); 
	} 
	else if (PIB->FWVersion < 8) 
	{ 
		struct PIB3_0 * PIB = (struct PIB3_0 *) (memory); 
		printf ("\tPIB %d-%d %d bytes\n", PIB->VersionHeader.FWVersion, PIB->VersionHeader.PIBVersion, LE16TOH (PIB->VersionHeader.PIBLength)); 
		printf ("\tMAC %s\n", hexstring (buffer, sizeof (buffer), PIB->LocalDeviceConfig.MAC, sizeof (PIB->LocalDeviceConfig.MAC))); 
		printf ("\tDAK %s", hexstring (buffer, sizeof (buffer), PIB->LocalDeviceConfig.DAK, sizeof (PIB->LocalDeviceConfig.DAK))); 
		for (key = 0; key < KEYS; key++) 
		{ 
			if (! memcmp (keys [key].DAK, PIB->LocalDeviceConfig.DAK, HPAVKEY_DAK_LEN)) 
			{ 
				printf (" (%s)", keys [key].phrase); 
				break; 
			} 
		} 
		printf ("\n"); 
		printf ("\tNMK %s", hexstring (buffer, sizeof (buffer), PIB->LocalDeviceConfig.NMK, sizeof (PIB->LocalDeviceConfig.NMK))); 
		for (key = 0; key < KEYS; key++) 
		{ 
			if (! memcmp (keys [key].NMK, PIB->LocalDeviceConfig.NMK, HPAVKEY_NMK_LEN)) 
			{ 
				printf (" (%s)", keys [key].phrase); 
				break; 
			} 
		} 
		printf ("\n"); 
		printf ("\tNID %s\n", hexstring (buffer, sizeof (buffer), PIB->LocalDeviceConfig.PreferredNID, sizeof (PIB->LocalDeviceConfig.PreferredNID))); 
		printf ("\tNET %s\n", PIB->LocalDeviceConfig.NET); 
		printf ("\tMFG %s\n", PIB->LocalDeviceConfig.MFG); 
		printf ("\tUSR %s\n", PIB->LocalDeviceConfig.USR); 
		printf ("\tCCo %s\n", CCoMode [PIB->LocalDeviceConfig.CCoSelection > SIZEOF (CCoMode) - 1? SIZEOF (CCoMode) - 1: PIB->LocalDeviceConfig.CCoSelection]); 
		printf ("\tMDU %s\n", PIB->LocalDeviceConfig.MDUConfiguration? MDURole [PIB->LocalDeviceConfig.MDURole & 1]: "N/A"); 
		return (0); 
	} 
	printf ("\tPIB %d-%d %d (unsupported)\n", PIB->FWVersion, PIB->PIBVersion, LE16TOH (PIB->PIBLength)); 
	return (1); 
} 

#endif