fill.c

MIPS下的boottloader yamon 的源代码

/************************************************************************
 *
 *  fill.c
 *
 *  Monitor command for filling memory.
 *
 *  fill [-8|-16|-32] <address> <size> <data>
 *
 *
 * ######################################################################
 *
 * Copyright (c) 1999-2000 MIPS Technologies, Inc. All rights reserved. 
 * 
 * Unpublished rights reserved under the Copyright Laws of the United States of 
 * America. 
 * 
 * This document contains information that is proprietary to MIPS Technologies, 
 * Inc. ("MIPS Technologies"). Any copying, modifying or use of this information 
 * (in whole or in part) which is not expressly permitted in writing by MIPS 
 * Technologies or a contractually-authorized third party is strictly 
 * prohibited. At a minimum, this information is protected under unfair 
 * competition laws and the expression of the information contained herein is 
 * protected under federal copyright laws. Violations thereof may result in 
 * criminal penalties and fines. 
 * MIPS Technologies or any contractually-authorized third party reserves the 
 * right to change the information contained in this document to improve 
 * function, design or otherwise. MIPS Technologies does not assume any 
 * liability arising out of the application or use of this information. Any 
 * license under patent rights or any other intellectual property rights owned 
 * by MIPS Technologies or third parties shall be conveyed by MIPS Technologies 
 * or any contractually-authorized third party in a separate license agreement 
 * between the parties. 
 * The information contained in this document constitutes one or more of the 
 * following: commercial computer software, commercial computer software 
 * documentation or other commercial items. If the user of this information, or 
 * any related documentation of any kind, including related technical data or 
 * manuals, is an agency, department, or other entity of the United States 
 * government ("Government"), the use, duplication, reproduction, release, 
 * modification, disclosure, or transfer of this information, or any related 
 * documentation of any kind, is restricted in accordance with Federal 
 * Acquisition Regulation 12.212 for civilian agencies and Defense Federal 
 * Acquisition Regulation Supplement 227.7202 for military agencies. The use of 
 * this information by the Government is further restricted in accordance with 
 * the terms of the license agreement(s) and/or applicable contract terms and 
 * conditions covering this information from MIPS Technologies or any 
 * contractually-authorized third party. 
 *
 ************************************************************************/


/************************************************************************
 *  Include files
 ************************************************************************/

#include <sysdefs.h>
#include <sys_api.h>
#include <string.h>
#include <stdio.h>
#include <ctype.h>
#include <shell_api.h>
#include "shell.h"

/************************************************************************
 *  Definitions
 ************************************************************************/

#define FILL_DEFAULT_WIDTH      sizeof(UINT8)

/************************************************************************
 *  Public variables
 ************************************************************************/

/************************************************************************
 *  Static variables
 ************************************************************************/

/* OPTIONS */
static t_cmd_option options[] =
{ 
#define OPTION_W8	0
  { "8",  "Fill data in units of bytes" },
#define OPTION_W16	1
  { "16", "Fill data in units of halfwords" },
#define OPTION_W32	2
  { "32", "Fill data in units of words" }
};
#define OPTION_COUNT	(sizeof(options)/sizeof(t_cmd_option))


/************************************************************************
 *  Static function prototypes
 ************************************************************************/

static UINT32 
get_options(
    UINT32 argc,
    char   **argv,
    UINT32 *width,
    UINT32 *address,
    UINT32 *length,
    UINT32 *data);

/************************************************************************
 *  Implementation : Static functions
 ************************************************************************/

/************************************************************************
 *                          fill
 ************************************************************************/
static MON_FUNC(fill)
{
    UINT32	width;
    UINT32	addr;
    UINT32	length;
    UINT32	data;
    void	*p;
    UINT32	rc;
        
    rc = get_options( argc, argv, &width, &addr, &length, &data );
  
    if( rc != OK )
        return rc;

    if (!length)
	return OK;

    switch (width) 
    {
      case sizeof(UINT8):
	data &= 0xff;
	printf("Filling from 0x%08X to 0x%08x with byte data 0x%02X.\n",
		addr, addr + length - 1, data);
	memset((void *) addr, data, length);
	break;

      case sizeof(UINT16):
	data &= 0xffff;
	printf("Filling from 0x%08X to 0x%08x with halfword data 0x%02X.\n",
		addr, addr + length - 1, data);
	for (p = (void *)addr;  
	     p < ((void *)addr) + length;  
	     p += sizeof(UINT16))
	{
	    *((UINT16 *) p) = data;
	}
	break;

      case sizeof(UINT32):
	data &= 0xffffffff;
	printf("Filling from 0x%08X to 0x%08x with word data 0x%02X.\n",
		addr, addr + length - 1, data);
	for (p = (void *)addr;  
	     p < ((void *)addr) + length;  
	     p += sizeof(UINT32))
	{
	    *((UINT32 *) p) = data;
	}
	break;

      default:
	return SHELL_ERROR_STRUCTURE;
	break;
    }

    return OK;
}

/************************************************************************
 *                          get_options
 ************************************************************************/
static UINT32
get_options(
    UINT32 argc,
    char   **argv,
    UINT32 *width,
    UINT32 *address,
    UINT32 *length,
    UINT32 *data)
{
    t_shell_option decode;
    UINT32	   type;
    bool	   ok 		 = TRUE;
    bool	   address_valid = FALSE;
    bool	   length_valid	 = FALSE;
    bool	   data_valid	 = FALSE;
    UINT32	   i;
    UINT32	   arg;
    UINT32	   error = SHELL_ERROR_SYNTAX;

    /* Setup defaults */
    *width = FILL_DEFAULT_WIDTH;

    for( arg = 1; 
	          ok && 
	          (arg < argc) && 
                  shell_decode_token( argv[arg], &type, &decode );
         arg++ )
    {
	switch( type )
	{
	  case SHELL_TOKEN_OPTION :
	    /* Find match */
	    for(i=0; 
		(i<OPTION_COUNT) &&
		(strcmp(decode.option, options[i].option) != 0);
		i++) ;

	    switch(i)
	    {
	      case OPTION_W8   :
		*width = sizeof(UINT8); break;
	      case OPTION_W16  :
		*width = sizeof(UINT16); break;
	      case OPTION_W32  :
		*width = sizeof(UINT32); break;
	      default :
	        error		 = SHELL_ERROR_OPTION;
		shell_error_data = argv[arg];
		ok		 = FALSE;
		break;		      
   	    }
	    break;

	  case SHELL_TOKEN_NUMBER :
	    if (!address_valid)
	    {
		*address      = decode.number;
		address_valid = TRUE;
	    }
	    else if (!length_valid)
	    {
		*length      = decode.number;
		length_valid = TRUE;
	    }
	    else if (!data_valid)
	    {
		*data      = decode.number;
		data_valid = TRUE;
	    }
	    else
	        ok = FALSE;
	    break;

	  default :
	    ok = FALSE;
	    break;
        }
    }

    if( !data_valid )
        ok = FALSE;

    if( ok && (*data > MAXUINT(*width)) )
    {
        ok    = FALSE;
	error = SHELL_ERROR_DATA_WIDTH;
    }

    return ok ?
        sys_validate_range( *address, *length, *width, TRUE ) :
        error;
}


/************************************************************************
 *                          cmd stuff
 ************************************************************************/

/* Command definition for fill */
static t_cmd cmd_def =
{
    "fill",
    fill,
    "fill [-8|-16|-32] <address> <size> <data>",

    "Fills the specified memory area starting at <address>. Default data\n"
    "width is 8 bits. <size> specifies the size of the area to fill\n"
    "(expressed in bytes).",

    options,
    OPTION_COUNT,
    FALSE
};


/************************************************************************
 *  Implementation : Public functions
 ************************************************************************/

/************************************************************************
 *
 *                          shell_fill_init
 *  Description :
 *  -------------
 *
 *  Initialise command
 *
 *  Return values :
 *  ---------------
 *
 *  void
 *
 ************************************************************************/
t_cmd *
shell_fill_init( void )
{
    return &cmd_def;
}