wine/msdos/ioports.c

/*
 * Emulation of processor ioports.
 *
 * Copyright 1995 Morten Welinder
 */

/* Known problems:
   - only a few ports are emulated.
   - real-time clock in "cmos" is bogus.  A nifty alarm() setup could
     fix that, I guess.
*/

#ifdef linux
#include <ctype.h>
#include <unistd.h>
#include <asm/io.h>
#include <string.h>
#include "options.h"
#endif

#include <stdio.h>
#include <stdlib.h>
#include <time.h>
#include "windows.h"
#include "stddebug.h"
/* #define DEBUG_INT */
#include "debug.h"

static BYTE cmosaddress;

static BYTE cmosimage[64] =
{
  0x27, 0x34, 0x31, 0x47, 0x16, 0x15, 0x00, 0x01,
  0x04, 0x94, 0x26, 0x02, 0x50, 0x80, 0x00, 0x00,
  0x40, 0xb1, 0x00, 0x9c, 0x01, 0x80, 0x02, 0x00,
  0x1c, 0x00, 0x00, 0xad, 0x02, 0x10, 0x00, 0x00,
  0x08, 0x00, 0x00, 0x26, 0x00, 0x00, 0x00, 0x00,
  0x00, 0x00, 0x00, 0x00, 0x00, 0x3f, 0x03, 0x58,
  0x00, 0x1c, 0x19, 0x81, 0x00, 0x0e, 0x00, 0x80,
  0x1b, 0x7b, 0x21, 0x00, 0x00, 0x00, 0x05, 0x5f
};

#ifdef linux
char do_direct_port_access = 0;
char port_permissions[0x10000];
#endif

/**********************************************************************
 *	    IO_port_init
 */

/* set_IO_permissions(int val1, int val)
 * Helper function for IO_port_init
 */
#ifdef linux
void set_IO_permissions(int val1, int val, char rw)
{
	int j;
	if (val1 != -1) {
		if (val == -1) val = 0x3ff;		
		for (j = val1; j <= val; j++)
			port_permissions[j] |= rw;		

		do_direct_port_access = 1;

		val1 = -1;
	} else if (val != -1) {		
		do_direct_port_access = 1;

		port_permissions[val] |= rw;
	}

}

/* do_IO_port_init_read_or_write(char* temp, char rw)
 * Helper function for IO_port_init
 */

void do_IO_port_init_read_or_write(char* temp, char rw)
{
	int val, val1, i, len;
	if (!strcasecmp(temp, "all")) {
		fprintf(stderr, "Warning!!! Granting FULL IO port access to"
			" windoze programs!\nWarning!!! "
			"*** THIS IS NOT AT ALL "
			"RECOMMENDED!!! ***\n");
		for (i=0; i < sizeof(port_permissions); i++)
			port_permissions[i] |= rw;

	} else if (!(!strcmp(temp, "*") || *temp == '\0')) {
		len = strlen(temp);
		val = -1;
		val1 = -1;		
		for (i = 0; i < len; i++) {
			switch (temp[i]) {
			case '0':
				if (temp[i+1] == 'x' || temp[i+1] == 'X') {
					sscanf(temp+i, "%x", &val);
					i += 2;
				} else {
					sscanf(temp+i, "%d", &val);
				}
				while (isxdigit(temp[i]))
					i++;
				i--;
				break;
			case ',':
			case ' ':
			case '\t':
				set_IO_permissions(val1, val, rw);
				val1 = -1; val = -1;
				break;
			case '-':
				val1 = val;
				if (val1 == -1) val1 = 0;
				break;
			default:
				if (temp[i] >= '0' && temp[i] <= '9') {
					sscanf(temp+i, "%d", &val);
					while (isdigit(temp[i]))
						i++;
				}
			}
		}
		set_IO_permissions(val1, val, rw);		
	}
}

#endif

void IO_port_init()
{
#ifdef linux
	char temp[1024];

	memset(port_permissions, 0, sizeof(port_permissions));
	do_direct_port_access = 0;

	/* Can we do that? */
	if (!iopl(3)) {
		iopl(0);

		PROFILE_GetWineIniString( "ports", "read", "*",
					 temp, sizeof(temp) );
		do_IO_port_init_read_or_write(temp, 1);
		PROFILE_GetWineIniString( "ports", "write", "*",
					 temp, sizeof(temp) );
		do_IO_port_init_read_or_write(temp, 2);
	}


#endif
}

/**********************************************************************
 *	    IO_inport
 */
DWORD IO_inport( int port, int count )
{
    DWORD res = 0;
    BYTE b;    

#ifdef linux    
    if (do_direct_port_access) iopl(3);
#endif

    dprintf_int(stddeb, "IO: %d bytes from port 0x%02x ", count, port );

    while (count-- > 0)
    {
#ifdef linux
	    if(port_permissions[port] & 1) {		    
		    b = inb(port);
	    } else 
#endif
	    {
		    switch (port)
		    {
		    case 0x70:
			    b = cmosaddress;
			    break;
		    case 0x71:
			    b = cmosimage[cmosaddress & 0x3f];
			    break;
		    default:
			    fprintf( stderr, 
				    "Direct I/O read attempted "
				    "from port %x\n", port);
			    b = 0xff;
			    break;
		    }
	    }

	    port++;
	    res = (res << 8) | b;
    }
#ifdef linux
    if (do_direct_port_access) iopl(0);
#endif
    dprintf_int(stddeb, "( 0x%lx )\n", res );
    return res;
}


/**********************************************************************
 *	    IO_outport
 */
void IO_outport( int port, int count, DWORD value )
{
    BYTE b;

    dprintf_int( stddeb, "IO: 0x%lx (%d bytes) to port 0x%02x\n",
                 value, count, port );

#ifdef linux
    if (do_direct_port_access) iopl(3);
#endif

    while (count-- > 0)
    {
        b = value & 0xff;
        value >>= 8;
#ifdef linux
	if (port_permissions[port] & 2) {
		outb(b, port);
	} else 
#endif
	{
		switch (port)
		{
		case 0x70:
			cmosaddress = b & 0x7f;
			break;
		case 0x71:
			cmosimage[cmosaddress & 0x3f] = b;
			break;
		default:
			fprintf( stderr, "Direct I/O write attempted "
				"to port %x\n", port );
			break;
		}
	}
	port++;
    }
#ifdef linux
    if (do_direct_port_access) iopl(0);
#endif
}