Subversion Repositories t48

/*
 * $Id: memory.c,v 1.2 2004-04-14 20:50:51 arniml Exp $
 *
 * Copyright (c) 2004, Arnim Laeuger (arniml@opencores.org)
 *
 * All rights reserved
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version. See also the file COPYING which
 *  came with this application.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
 */
 
#include <stdio.h>
#include <string.h>
 
#include "memory.h"
#include "i8039.h"
 
 
static UINT8 code_mem[4096];
 
 
static UINT8 port1 = 0xff, port2 = 0xff;
 
 
UINT8 program_read_byte_8(UINT16 address)
{
  return(code_mem[address]);
}
 
UINT8 cpu_readop(UINT16 address)
{
  return(code_mem[address]);
}
 
UINT8 cpu_readop_arg(UINT16 address)
{
  return(code_mem[address]);
}
 
 
UINT8 io_read_byte_8(UINT8 address)
{
  UINT8 data;
 
  switch (0x100 | address) {
    case I8039_p1:
      data = port1;
      break;
 
    case I8039_p2:
      data = port2;
      break;
 
    case I8039_t0:
      /* connect T0 to P1[0] */
      data = port1 & 0x01;
      break;
 
    case I8039_t1:
      /* connect T1 to P1[1] */
      data = (port1 & 0x02) >> 1;
      break;
 
    default:
      data = 0;
      break;
  }
 
 
  return(data);
}
 
 
void io_write_byte_8(UINT8 address, UINT8 data)
{
  switch (0x100 | address) {
    case I8039_p1:
      port1 = data;
      break;
 
    case I8039_p2:
      port2 = data;
      break;
 
    default:
      break;
  }
}
 
 
int read_hex_file(char *filename)
{
  FILE *hex_file;
  UINT16 record_len, offset, record_type;
  UINT16 byte;
  char line[540];
  char *payload, *idx;
  int result = 0;
 
  record_len = offset = record_type = 0;
  hex_file = fopen(filename, "r");
  if (hex_file != NULL) {
 
    while (fgets(line, 539, hex_file)) {
      if (sscanf(line, ":%2hx%4hx%2hx", &record_len, &offset, &record_type) == 3) {
        /* strip off newline */
        idx = (char *)strchr(line, '\n');
        if (idx != NULL)
          *idx = '\0';
        /* extract payload */
        payload = &(line[9]);
        /* strip of checksum */
        if (strlen(payload) > 2)
          payload[strlen(payload) - 2] = '\0';
 
        /* read payload to array */
        if (record_type == 0) {
          while (strlen(payload) >= 2) {
            if (sscanf(payload, "%2hx", &byte) == 1)
              code_mem[offset++] = byte;
 
            payload++;
            payload++;
          }
        }
 
      }
    }
 
    result = 1;
 
    fclose(hex_file);
  }
 
  return(result);
}