NetBSD/dist/pdisk/layout_dump.c

182 lines
4.2 KiB
C

/*
* layout_dump.c -
*
* Written by Eryk Vershen
*/
/*
* Copyright 1996,1997 by Apple Computer, Inc.
* All Rights Reserved
*
* Permission to use, copy, modify, and distribute this software and
* its documentation for any purpose and without fee is hereby granted,
* provided that the above copyright notice appears in all copies and
* that both the copyright notice and this permission notice appear in
* supporting documentation.
*
* APPLE COMPUTER DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE
* INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
* FOR A PARTICULAR PURPOSE.
*
* IN NO EVENT SHALL APPLE COMPUTER BE LIABLE FOR ANY SPECIAL, INDIRECT, OR
* CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM
* LOSS OF USE, DATA OR PROFITS, WHETHER IN ACTION OF CONTRACT,
* NEGLIGENCE, OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION
* WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*/
// for printf()
#include <stdio.h>
// for strlen()
#include <string.h>
#include <inttypes.h>
#include "layout_dump.h"
/*
* Defines
*/
/*
* Types
*/
/*
* Global Constants
*/
uint8_t bitmasks[] = {
0x01, 0x03, 0x07, 0x0F,
0x1F, 0x3F, 0x7F, 0xFF
};
/*
* Global Variables
*/
/*
* Forward declarations
*/
/*
* Routines
*/
void
dump_using_layout(void *buffer, layout *desc)
{
layout *entry;
int byte_length;
long value;
int max_name;
int i;
max_name = 0;
for (entry = desc; entry->format != kEnd; entry++) {
value = strlen(entry->name);
if (value > max_name) {
max_name = value;
}
}
for (entry = desc; entry->format != kEnd; entry++) {
if (entry->format != kBit) {
printf("%*s: ", max_name, entry->name);
byte_length = entry->bit_length / 8;
if (entry->bit_offset != 0 || (entry->bit_length % 8) != 0) {
printf("entry %d, can't handle bitfields yet.\n", (int)(entry - desc));
continue;
}
value = 0;
for (i = entry->byte_offset; byte_length > 0;i++) {
value = value << 8;
value |= ((uint8_t *)buffer)[i];
byte_length--;
}
} else {
if (entry->bit_offset < 0 || entry->bit_offset > 8) {
printf("entry %d, bad bit offset (%d).\n", (int)(entry - desc), entry->bit_offset);
continue;
} else if (entry->bit_length <= 0
|| entry->bit_length > (entry->bit_offset + 1)) {
printf("entry %d, bad bit length (%d,%d).\n", (int)(entry - desc),
entry->bit_offset, entry->bit_length);
continue;
}
value = (((uint8_t *)buffer)[entry->byte_offset]
& bitmasks[entry->bit_offset])
>> ((entry->bit_offset + 1) - entry->bit_length);
}
switch (entry->format) {
case kHex:
printf("0x%x\n", (uint32_t) value);
break;
case kDec:
byte_length = entry->bit_length / 8;
switch (byte_length) {
case 4: printf("%"PRId32"\n", (int32_t)value); break;
case 2: printf("%"PRId16"\n", (int16_t)value); break;
case 1: printf("%"PRId8"\n", (int8_t)value); break;
}
break;
case kUns:
byte_length = entry->bit_length / 8;
switch (byte_length) {
case 4: printf("%"PRIu32"\n", (uint32_t)value); break;
case 2: printf("%"PRIu16"\n", (uint16_t)value); break;
case 1: printf("%"PRIu8"\n", (uint8_t)value); break;
}
break;
case kBit:
if (value) {
printf("%*s %s\n", max_name, "", entry->name);
}
break;
default:
printf("entry %d, unknown format (%d).\n", (int)(entry - desc), entry->format);
break;
}
}
}
void
DumpRawBuffer(uint8_t *bufferPtr, int length )
{
register int i;
int lineStart;
int lineLength;
short c;
#define kLineSize 16
for (lineStart = 0; lineStart < length; lineStart += lineLength) {
lineLength = kLineSize;
if (lineStart + lineLength > length)
lineLength = length - lineStart;
printf("%03x %3d:", lineStart, lineStart);
for (i = 0; i < lineLength; i++)
printf(" %02x", bufferPtr[lineStart + i] & 0xFF);
for (; i < kLineSize; i++)
printf(" ");
printf(" ");
for (i = 0; i < lineLength; i++) {
c = bufferPtr[lineStart + i] & 0xFF;
if (c > ' ' && c < '~')
printf("%c", c);
else {
printf(".");
}
}
printf("\n");
}
}