350 lines
12 KiB
C++
350 lines
12 KiB
C++
/////////////////////////////////////////////////////////////////////////
|
|
// $Id: parallel.cc,v 1.30 2006-05-29 22:33:38 sshwarts Exp $
|
|
/////////////////////////////////////////////////////////////////////////
|
|
//
|
|
// Copyright (C) 2002 MandrakeSoft S.A.
|
|
//
|
|
// MandrakeSoft S.A.
|
|
// 43, rue d'Aboukir
|
|
// 75002 Paris - France
|
|
// http://www.linux-mandrake.com/
|
|
// http://www.mandrakesoft.com/
|
|
//
|
|
// This library is free software; you can redistribute it and/or
|
|
// modify it under the terms of the GNU Lesser General Public
|
|
// License as published by the Free Software Foundation; either
|
|
// version 2 of the License, or (at your option) any later version.
|
|
//
|
|
// This library 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
|
|
// Lesser General Public License for more details.
|
|
//
|
|
// You should have received a copy of the GNU Lesser General Public
|
|
// License along with this library; if not, write to the Free Software
|
|
// Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
//
|
|
////////////////////////////////////////////////////////
|
|
// This code was just a few stubs until Volker.Ruppert@t-online.de
|
|
// fixed it up in November 2001.
|
|
|
|
|
|
// Define BX_PLUGGABLE in files that can be compiled into plugins. For
|
|
// platforms that require a special tag on exported symbols, BX_PLUGGABLE
|
|
// is used to know when we are exporting symbols and when we are importing.
|
|
#define BX_PLUGGABLE
|
|
|
|
#include "iodev.h"
|
|
#define LOG_THIS theParallelDevice->
|
|
|
|
bx_parallel_c *theParallelDevice = NULL;
|
|
|
|
int libparallel_LTX_plugin_init(plugin_t *plugin, plugintype_t type, int argc, char *argv[])
|
|
{
|
|
theParallelDevice = new bx_parallel_c ();
|
|
bx_devices.pluginParallelDevice = theParallelDevice;
|
|
BX_REGISTER_DEVICE_DEVMODEL(plugin, type, theParallelDevice, BX_PLUGIN_PARALLEL);
|
|
return(0); // Success
|
|
}
|
|
|
|
void libparallel_LTX_plugin_fini(void)
|
|
{
|
|
}
|
|
|
|
bx_parallel_c::bx_parallel_c()
|
|
{
|
|
put("PAR");
|
|
settype(PARLOG);
|
|
for (int i=0; i<BX_PARPORT_MAXDEV; i++) {
|
|
s[i].output = NULL;
|
|
}
|
|
}
|
|
|
|
bx_parallel_c::~bx_parallel_c()
|
|
{
|
|
for (int i=0; i<BX_PARPORT_MAXDEV; i++) {
|
|
if (s[i].output != NULL)
|
|
fclose(s[i].output);
|
|
}
|
|
}
|
|
|
|
void bx_parallel_c::init(void)
|
|
{
|
|
Bit16u ports[BX_PARPORT_MAXDEV] = {0x0378, 0x0278};
|
|
Bit8u irqs[BX_PARPORT_MAXDEV] = {7, 5};
|
|
char name[16], pname[20];
|
|
bx_list_c *base;
|
|
|
|
BX_DEBUG(("Init $Id: parallel.cc,v 1.30 2006-05-29 22:33:38 sshwarts Exp $"));
|
|
|
|
for (unsigned i=0; i<BX_N_PARALLEL_PORTS; i++) {
|
|
sprintf(pname, "ports.parallel.%d", i+1);
|
|
base = (bx_list_c*) SIM->get_param(pname);
|
|
if (SIM->get_param_bool("enabled", base)->get()) {
|
|
sprintf(name, "Parallel Port %d", i + 1);
|
|
/* parallel interrupt and i/o ports */
|
|
BX_PAR_THIS s[i].IRQ = irqs[i];
|
|
for (unsigned addr=ports[i]; addr<=(unsigned)(ports[i]+2); addr++) {
|
|
DEV_register_ioread_handler(this, read_handler, addr, name, 1);
|
|
}
|
|
DEV_register_iowrite_handler(this, write_handler, ports[i], name, 1);
|
|
DEV_register_iowrite_handler(this, write_handler, ports[i]+2, name, 1);
|
|
BX_INFO (("parallel port %d at 0x%04x irq %d", i+1, ports[i], irqs[i]));
|
|
/* internal state */
|
|
BX_PAR_THIS s[i].STATUS.error = 1;
|
|
BX_PAR_THIS s[i].STATUS.slct = 1;
|
|
BX_PAR_THIS s[i].STATUS.pe = 0;
|
|
BX_PAR_THIS s[i].STATUS.ack = 1;
|
|
BX_PAR_THIS s[i].STATUS.busy = 1;
|
|
|
|
BX_PAR_THIS s[i].CONTROL.strobe = 0;
|
|
BX_PAR_THIS s[i].CONTROL.autofeed = 0;
|
|
BX_PAR_THIS s[i].CONTROL.init = 1;
|
|
BX_PAR_THIS s[i].CONTROL.slct_in = 1;
|
|
BX_PAR_THIS s[i].CONTROL.irq = 0;
|
|
BX_PAR_THIS s[i].CONTROL.input = 0;
|
|
|
|
BX_PAR_THIS s[i].initmode = 0;
|
|
/* output file */
|
|
char *outfile = SIM->get_param_string("outfile", base)->getptr();
|
|
if (strlen(outfile) > 0) {
|
|
s[i].output = fopen(outfile, "wb");
|
|
if (!s[i].output)
|
|
BX_PANIC(("Could not open '%s' to write parport%d output",
|
|
outfile, i+1));
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void bx_parallel_c::reset(unsigned type)
|
|
{
|
|
}
|
|
|
|
#if BX_SUPPORT_SAVE_RESTORE
|
|
void bx_parallel_c::register_state(void)
|
|
{
|
|
unsigned i;
|
|
char name[4], pname[20];
|
|
bx_list_c *base, *port;
|
|
|
|
bx_list_c *list = new bx_list_c(SIM->get_sr_root(), "parallel", "Parallel Port State");
|
|
for (i=0; i<BX_N_PARALLEL_PORTS; i++) {
|
|
sprintf(pname, "ports.parallel.%d", i+1);
|
|
base = (bx_list_c*) SIM->get_param(pname);
|
|
if (SIM->get_param_bool("enabled", base)->get()) {
|
|
sprintf(name, "%d", i);
|
|
port = new bx_list_c(list, name, 11);
|
|
new bx_shadow_num_c(port, "data", &BX_PAR_THIS s[i].data, BASE_HEX);
|
|
new bx_shadow_bool_c(port, "slct", &BX_PAR_THIS s[i].STATUS.slct);
|
|
new bx_shadow_bool_c(port, "ack", &BX_PAR_THIS s[i].STATUS.ack);
|
|
new bx_shadow_bool_c(port, "busy", &BX_PAR_THIS s[i].STATUS.busy);
|
|
new bx_shadow_bool_c(port, "strobe", &BX_PAR_THIS s[i].CONTROL.strobe);
|
|
new bx_shadow_bool_c(port, "autofeed", &BX_PAR_THIS s[i].CONTROL.autofeed);
|
|
new bx_shadow_bool_c(port, "init", &BX_PAR_THIS s[i].CONTROL.init);
|
|
new bx_shadow_bool_c(port, "slct_in", &BX_PAR_THIS s[i].CONTROL.slct_in);
|
|
new bx_shadow_bool_c(port, "irq", &BX_PAR_THIS s[i].CONTROL.irq);
|
|
new bx_shadow_bool_c(port, "input", &BX_PAR_THIS s[i].CONTROL.input);
|
|
new bx_shadow_bool_c(port, "initmode", &BX_PAR_THIS s[i].initmode);
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
|
|
void bx_parallel_c::virtual_printer(Bit8u port)
|
|
{
|
|
if (BX_PAR_THIS s[port].STATUS.slct) {
|
|
if (BX_PAR_THIS s[port].output != NULL) {
|
|
fputc(BX_PAR_THIS s[port].data, BX_PAR_THIS s[port].output);
|
|
fflush (BX_PAR_THIS s[port].output);
|
|
}
|
|
if (BX_PAR_THIS s[port].CONTROL.irq == 1) {
|
|
DEV_pic_raise_irq(BX_PAR_THIS s[port].IRQ);
|
|
}
|
|
BX_PAR_THIS s[port].STATUS.ack = 0;
|
|
BX_PAR_THIS s[port].STATUS.busy = 1;
|
|
}
|
|
else {
|
|
BX_ERROR(("data is valid, but printer is offline"));
|
|
}
|
|
}
|
|
|
|
// static IO port read callback handler
|
|
// redirects to non-static class handler to avoid virtual functions
|
|
|
|
Bit32u bx_parallel_c::read_handler(void *this_ptr, Bit32u address, unsigned io_len)
|
|
{
|
|
#if !BX_USE_PAR_SMF
|
|
bx_parallel_c *class_ptr = (bx_parallel_c *) this_ptr;
|
|
return class_ptr->read(address, io_len);
|
|
}
|
|
|
|
Bit32u bx_parallel_c::read(Bit32u address, unsigned io_len)
|
|
{
|
|
#else
|
|
UNUSED(this_ptr);
|
|
#endif // !BX_USE_PAR_SMF
|
|
Bit8u offset;
|
|
Bit8u port = 0;
|
|
Bit32u retval;
|
|
|
|
offset = address & 0x07;
|
|
switch (address & 0x03f8) {
|
|
case 0x0378: port = 0; break;
|
|
case 0x0278: port = 1; break;
|
|
}
|
|
|
|
switch (offset) {
|
|
case BX_PAR_DATA:
|
|
if (!BX_PAR_THIS s[port].CONTROL.input) {
|
|
return (Bit32u)BX_PAR_THIS s[port].data;
|
|
} else {
|
|
BX_ERROR(("read: input mode not supported"));
|
|
return (0xFF);
|
|
}
|
|
break;
|
|
case BX_PAR_STAT:
|
|
{
|
|
retval = ((BX_PAR_THIS s[port].STATUS.busy << 7) |
|
|
(BX_PAR_THIS s[port].STATUS.ack << 6) |
|
|
(BX_PAR_THIS s[port].STATUS.pe << 5) |
|
|
(BX_PAR_THIS s[port].STATUS.slct << 4) |
|
|
(BX_PAR_THIS s[port].STATUS.error << 3));
|
|
if (BX_PAR_THIS s[port].STATUS.ack == 0) {
|
|
BX_PAR_THIS s[port].STATUS.ack = 1;
|
|
if (BX_PAR_THIS s[port].CONTROL.irq == 1) {
|
|
DEV_pic_lower_irq(BX_PAR_THIS s[port].IRQ);
|
|
}
|
|
}
|
|
if (BX_PAR_THIS s[port].initmode == 1) {
|
|
BX_PAR_THIS s[port].STATUS.busy = 1;
|
|
BX_PAR_THIS s[port].STATUS.slct = 1;
|
|
BX_PAR_THIS s[port].STATUS.ack = 0;
|
|
if (BX_PAR_THIS s[port].CONTROL.irq == 1) {
|
|
DEV_pic_raise_irq(BX_PAR_THIS s[port].IRQ);
|
|
}
|
|
BX_PAR_THIS s[port].initmode = 0;
|
|
}
|
|
BX_DEBUG(("read: parport%d status register returns 0x%02x", port+1, retval));
|
|
return retval;
|
|
}
|
|
break;
|
|
case BX_PAR_CTRL:
|
|
{
|
|
retval = ((BX_PAR_THIS s[port].CONTROL.input << 5) |
|
|
(BX_PAR_THIS s[port].CONTROL.irq << 4) |
|
|
(BX_PAR_THIS s[port].CONTROL.slct_in << 3) |
|
|
(BX_PAR_THIS s[port].CONTROL.init << 2) |
|
|
(BX_PAR_THIS s[port].CONTROL.autofeed << 1) |
|
|
(BX_PAR_THIS s[port].CONTROL.strobe));
|
|
BX_DEBUG(("read: parport%d control register returns 0x%02x", port+1, retval));
|
|
return retval;
|
|
}
|
|
break;
|
|
}
|
|
return(0);
|
|
}
|
|
|
|
// static IO port write callback handler
|
|
// redirects to non-static class handler to avoid virtual functions
|
|
|
|
void bx_parallel_c::write_handler(void *this_ptr, Bit32u address, Bit32u value, unsigned io_len)
|
|
{
|
|
#if !BX_USE_PAR_SMF
|
|
bx_parallel_c *class_ptr = (bx_parallel_c *) this_ptr;
|
|
|
|
class_ptr->write(address, value, io_len);
|
|
}
|
|
|
|
void bx_parallel_c::write(Bit32u address, Bit32u value, unsigned io_len)
|
|
{
|
|
#else
|
|
UNUSED(this_ptr);
|
|
#endif // !BX_USE_PAR_SMF
|
|
Bit8u offset;
|
|
Bit8u port = 0;
|
|
char name[16];
|
|
|
|
offset = address & 0x07;
|
|
switch (address & 0x03f8) {
|
|
case 0x0378: port = 0; break;
|
|
case 0x0278: port = 1; break;
|
|
}
|
|
|
|
switch (offset) {
|
|
case BX_PAR_DATA:
|
|
BX_PAR_THIS s[port].data = (Bit8u)value;
|
|
BX_DEBUG(("write: parport%d data output register = 0x%02x", port+1, (Bit8u)value));
|
|
break;
|
|
case BX_PAR_CTRL:
|
|
{
|
|
if ((value & 0x01) == 0x01) {
|
|
if (BX_PAR_THIS s[port].CONTROL.strobe == 0) {
|
|
BX_PAR_THIS s[port].CONTROL.strobe = 1;
|
|
virtual_printer(port); // data is valid now
|
|
}
|
|
} else {
|
|
if (BX_PAR_THIS s[port].CONTROL.strobe == 1) {
|
|
BX_PAR_THIS s[port].CONTROL.strobe = 0;
|
|
}
|
|
}
|
|
BX_PAR_THIS s[port].CONTROL.autofeed = ((value & 0x02) == 0x02);
|
|
if ((value & 0x04) == 0x04) {
|
|
if (BX_PAR_THIS s[port].CONTROL.init == 0) {
|
|
BX_PAR_THIS s[port].CONTROL.init = 1;
|
|
BX_PAR_THIS s[port].STATUS.busy = 0;
|
|
BX_PAR_THIS s[port].STATUS.slct = 0;
|
|
BX_PAR_THIS s[port].initmode = 1;
|
|
BX_DEBUG(("parport%d: printer init requested", port+1));
|
|
}
|
|
} else {
|
|
if (BX_PAR_THIS s[port].CONTROL.init == 1) {
|
|
BX_PAR_THIS s[port].CONTROL.init = 0;
|
|
}
|
|
}
|
|
if ((value & 0x08) == 0x08) {
|
|
if (BX_PAR_THIS s[port].CONTROL.slct_in == 0) {
|
|
BX_PAR_THIS s[port].CONTROL.slct_in = 1;
|
|
BX_DEBUG(("parport%d: printer now online", port+1));
|
|
}
|
|
} else {
|
|
if (BX_PAR_THIS s[port].CONTROL.slct_in == 1) {
|
|
BX_PAR_THIS s[port].CONTROL.slct_in = 0;
|
|
BX_DEBUG(("parport%d: printer now offline", port+1));
|
|
}
|
|
}
|
|
BX_PAR_THIS s[port].STATUS.slct = BX_PAR_THIS s[port].CONTROL.slct_in;
|
|
if ((value & 0x10) == 0x10) {
|
|
if (BX_PAR_THIS s[port].CONTROL.irq == 0) {
|
|
BX_PAR_THIS s[port].CONTROL.irq = 1;
|
|
sprintf(name, "Parallel Port %d", port+1);
|
|
DEV_register_irq(BX_PAR_THIS s[port].IRQ, name);
|
|
BX_DEBUG(("parport%d: irq mode selected", port+1));
|
|
}
|
|
} else {
|
|
if (BX_PAR_THIS s[port].CONTROL.irq == 1) {
|
|
BX_PAR_THIS s[port].CONTROL.irq = 0;
|
|
sprintf(name, "Parallel Port %d", port+1);
|
|
DEV_unregister_irq(BX_PAR_THIS s[port].IRQ, name);
|
|
BX_DEBUG(("parport%d: polling mode selected", port+1));
|
|
}
|
|
}
|
|
if ((value & 0x20) == 0x20) {
|
|
if (BX_PAR_THIS s[port].CONTROL.input == 0) {
|
|
BX_PAR_THIS s[port].CONTROL.input = 1;
|
|
BX_DEBUG(("parport%d: data input mode selected", port+1));
|
|
}
|
|
} else {
|
|
if (BX_PAR_THIS s[port].CONTROL.input == 1) {
|
|
BX_PAR_THIS s[port].CONTROL.input = 0;
|
|
BX_DEBUG(("parport%d: data output mode selected", port+1));
|
|
}
|
|
}
|
|
if ((value & 0xC0) > 0) {
|
|
BX_ERROR(("write: parport%d: unsupported control bit ignored", port+1));
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
}
|