/*
* 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");
       }
}