/*====================================================================* * * 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 * *--------------------------------------------------------------------*/ #ifndef LIGHTNING_PIB_PEEK_SOURCE #define LIGHTNING_PIB_PEEK_SOURCE #include #include #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