/*
 * Copyright (c) 2002 Michael Ruff (mruff at chiaro.com)
 *                    Michael Runyan (mrunyan at chiaro.com)
 *
 *    This source code is free software; you can redistribute it
 *    and/or modify it in source code form 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.
 *
 *    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 "vpi_user.h"

// A 76 bit value
char *str[4] = {
 "f00cafababedeabbeef",
 "70850123451113459662575",
 "17001453725653733652737357",
 "1111000000001100101011111010101110101011111011011110101010111011111011101111"
};

static int
MemPeek(char *)
{
    vpiHandle	mod_h, mem_h, iterate, handle;
    s_vpi_value	value;
    int		cnt = 0;
    char	*orig;

    vpi_printf("MemPeek Callback\n");

    // get top module handle
    iterate = vpi_iterate(vpiModule, NULL);
    if (iterate == NULL) return -1;
    mod_h = vpi_scan(iterate);

    // Get memory
    iterate = vpi_iterate(vpiMemory, mod_h);
    if (iterate != NULL) {
        while ((handle = vpi_scan(iterate))) {
            if (!strcmp("m_peek", vpi_get_str(vpiName, handle))) {
		vpi_printf("  Found %s (%d deep x %d bits)\n", 
		    vpi_get_str(vpiName, handle),
		    vpi_get(vpiSize, handle),
		    vpi_get(vpiSize,
			vpi_scan(vpi_iterate(vpiMemoryWord, handle))));
		mem_h = handle;
                break;
            }
        }
    }

    // Get value
    iterate = vpi_iterate(vpiMemoryWord, mem_h);
    while ((handle = vpi_scan(iterate))) {
	switch (cnt % 4) {
	    case 0:
		value.format=vpiBinStrVal;
		orig = str[3];
		break;
	    case 1:
		value.format=vpiOctStrVal;
		orig = str[2];
		break;
	    case 2:
		value.format=vpiDecStrVal;
		orig = str[1];
		break;
	    case 3:
		value.format=vpiHexStrVal;
		orig = str[0];
		break;
	}
	// Get current value
	vpi_get_value(handle, &value);
	vpi_printf("%0d: %s%s\n", cnt, value.value.str,
	    strcmp(orig, value.value.str) ? " ERROR" : "");
	cnt++;
    }

    return 0;
}

static int
MemPoke(char *)
{
    vpiHandle	mod_h, mem_h, iterate, handle;
    s_vpi_value	value;
    int		cnt = 0;

    vpi_printf("MemPoke Callback\n");

    // get top module handle
    iterate = vpi_iterate(vpiModule, NULL);
    if (iterate == NULL) return -1;
    mod_h = vpi_scan(iterate);

    // Get memory
    iterate = vpi_iterate(vpiMemory, mod_h);
    if (iterate != NULL) {
        while ((handle = vpi_scan(iterate))) {
            if (!strcmp("m_poke", vpi_get_str(vpiName, handle))) {
		vpi_printf("  Found %s (%d deep x %d bits)\n", 
		    vpi_get_str(vpiName, handle),
		    vpi_get(vpiSize, handle),
		    vpi_get(vpiSize,
			vpi_scan(vpi_iterate(vpiMemoryWord, handle))));
		mem_h = handle;
                break;
            }
        }
    }

    // Poke memory using strings
    iterate = vpi_iterate(vpiMemoryWord, mem_h);
    while ((handle = vpi_scan(iterate))) {
	switch (cnt % 4) {
	    case 0:
		value.format=vpiHexStrVal;
		value.value.str = str[0];
		break;
	    case 1:
		value.format=vpiDecStrVal;
		value.value.str = str[1];
		break;
	    case 2:
		value.format=vpiOctStrVal;
		value.value.str = str[2];
		break;
	    case 3:
		value.format=vpiBinStrVal;
		value.value.str = str[3];
		break;
	}
	vpi_printf("%0d: %s\n", cnt, value.value.str);
	vpi_put_value(handle, &value, NULL, vpiNoDelay);
	cnt++;
    }

    return 0;
}

static void
RegisterCallbacks(void)
{
    s_vpi_systf_data tf_data;

    vpi_printf("Registering Callbacks\n");

    tf_data.type = vpiSysTask;
    tf_data.tfname = "$mempoke";
    tf_data.calltf = MemPoke;
    tf_data.compiletf = 0;
    tf_data.sizetf = 0;
    vpi_register_systf(&tf_data);

    tf_data.tfname = "$mempeek";
    tf_data.calltf = MemPeek;
    vpi_register_systf(&tf_data);
}

void (*vlog_startup_routines[])() =
{
    RegisterCallbacks,
    0
};