#include "opt_ppb_1284.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/bus.h>
#include <machine/clock.h>
#include "ppbconf.h"
#include "ppb_1284.h"
#include "ppbus_if.h"
#include "ppbio.h"
#define DEVTOSOFTC(dev) ((struct ppb_data *)device_get_softc(dev))
static int
do_1284_wait(device_t bus, char mask, char status)
{
return (ppb_poll_bus(bus, 4, mask, status, PPB_NOINTR | PPB_POLL));
}
static int
do_peripheral_wait(device_t bus, char mask, char status)
{
return (ppb_poll_bus(bus, 100, mask, status, PPB_NOINTR | PPB_POLL));
}
#define nibble2char(s) (((s & ~nACK) >> 3) | (~s & nBUSY) >> 4)
static int
ppb_1284_reset_error(device_t bus, int state)
{
struct ppb_data *ppb = DEVTOSOFTC(bus);
ppb->error = PPB_NO_ERROR;
ppb->state = state;
return (0);
}
int
ppb_1284_get_state(device_t bus)
{
return (DEVTOSOFTC(bus)->state);
}
int
ppb_1284_set_state(device_t bus, int state)
{
struct ppb_data *ppb = DEVTOSOFTC(bus);
if ((ppb->state != PPB_ERROR) &&
(ppb->error == PPB_NO_ERROR)) {
ppb->state = state;
ppb->error = PPB_NO_ERROR;
}
return (0);
}
static int
ppb_1284_set_error(device_t bus, int error, int event)
{
struct ppb_data *ppb = DEVTOSOFTC(bus);
if ((ppb->error == PPB_NO_ERROR) &&
(ppb->state != PPB_ERROR)) {
ppb->error = error;
ppb->state = PPB_ERROR;
}
#ifdef DEBUG_1284
kprintf("ppb1284: error=%d status=0x%x event=%d\n", error,
ppb_rstr(bus) & 0xff, event);
#endif
return (0);
}
static int
ppb_request_mode(int mode, int options)
{
int request_mode = 0;
if (options & PPB_EXTENSIBILITY_LINK) {
request_mode = EXT_LINK_1284_NORMAL;
} else {
switch (mode) {
case PPB_NIBBLE:
request_mode = (options & PPB_REQUEST_ID) ?
NIBBLE_1284_REQUEST_ID :
NIBBLE_1284_NORMAL;
break;
case PPB_PS2:
request_mode = (options & PPB_REQUEST_ID) ?
BYTE_1284_REQUEST_ID :
BYTE_1284_NORMAL;
break;
case PPB_ECP:
if (options & PPB_USE_RLE)
request_mode = (options & PPB_REQUEST_ID) ?
ECP_1284_RLE_REQUEST_ID :
ECP_1284_RLE;
else
request_mode = (options & PPB_REQUEST_ID) ?
ECP_1284_REQUEST_ID :
ECP_1284_NORMAL;
break;
case PPB_EPP:
request_mode = EPP_1284_NORMAL;
break;
default:
panic("%s: unsupported mode %d", __func__, mode);
}
}
return (request_mode);
}
int
ppb_peripheral_negotiate(device_t bus, int mode, int options)
{
int spin, request_mode, error = 0;
char r;
ppb_set_mode(bus, PPB_COMPATIBLE);
ppb_1284_set_state(bus, PPB_PERIPHERAL_NEGOTIATION);
request_mode = ppb_request_mode(mode, options);
spin = 10;
while (spin-- && (ppb_rstr(bus) & nBUSY))
DELAY(1);
if (!(ppb_rstr(bus) & SELECT) || !spin) {
error = ENODEV;
goto error;
}
r = ppb_rdtr(bus);
if ((r == (char)request_mode) ||
(r == NIBBLE_1284_NORMAL)) {
ppb_wctr(bus, (STROBE | nINIT) & ~(SELECTIN));
DELAY(1);
ppb_wctr(bus, (nINIT) & ~(SELECTIN | STROBE));
if (r == NIBBLE_1284_NORMAL) {
#ifdef DEBUG_1284
kprintf("R");
#endif
ppb_1284_set_error(bus, PPB_MODE_UNSUPPORTED, 4);
error = EINVAL;
goto error;
} else {
ppb_1284_set_state(bus, PPB_PERIPHERAL_IDLE);
switch (r) {
case BYTE_1284_NORMAL:
ppb_set_mode(bus, PPB_BYTE);
break;
default:
break;
}
#ifdef DEBUG_1284
kprintf("A");
#endif
}
} else {
ppb_wctr(bus, SELECTIN);
DELAY(1);
ppb_wctr(bus, (SELECTIN) & ~(STROBE | nINIT));
ppb_1284_set_error(bus, PPB_MODE_UNSUPPORTED, 4);
#ifdef DEBUG_1284
kprintf("r");
#endif
error = EINVAL;
goto error;
}
return (0);
error:
ppb_peripheral_terminate(bus, PPB_WAIT);
return (error);
}
int
ppb_peripheral_terminate(device_t bus, int how)
{
int error = 0;
#ifdef DEBUG_1284
kprintf("t");
#endif
ppb_1284_set_state(bus, PPB_PERIPHERAL_TERMINATION);
if ((error = do_peripheral_wait(bus, SELECT | nBUSY, 0))) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 22);
goto error;
}
ppb_wctr(bus, (nINIT | STROBE) & ~(AUTOFEED | SELECTIN));
if ((error = do_peripheral_wait(bus, nBUSY, nBUSY))) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 25);
goto error;
}
ppb_wctr(bus, (SELECTIN | nINIT | STROBE) & ~(AUTOFEED));
DELAY(1);
ppb_wctr(bus, (SELECTIN | nINIT) & ~(STROBE | AUTOFEED));
if ((error = do_peripheral_wait(bus, nBUSY, 0))) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 28);
goto error;
}
error:
ppb_set_mode(bus, PPB_COMPATIBLE);
ppb_1284_set_state(bus, PPB_FORWARD_IDLE);
return (0);
}
static int
byte_peripheral_outbyte(device_t bus, char *buffer, int last)
{
int error = 0;
if ((error = do_1284_wait(bus, nBUSY, nBUSY))) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 7);
goto error;
}
if (!(ppb_rstr(bus) & SELECT)) {
ppb_peripheral_terminate(bus, PPB_WAIT);
goto error;
}
#ifdef DEBUG_1284
kprintf("B");
#endif
ppb_wdtr(bus, *buffer);
ppb_wctr(bus, (AUTOFEED | STROBE) & ~(nINIT | SELECTIN));
if ((error = do_peripheral_wait(bus, nBUSY, 0))) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 16);
goto error;
}
if (!last) {
ppb_wctr(bus, (AUTOFEED) & ~(nINIT | STROBE | SELECTIN));
} else {
ppb_wctr(bus, (nINIT) & ~(STROBE | SELECTIN | AUTOFEED));
}
#if 0
if ((error = do_peripheral_wait(bus, nACK | nBUSY, 0))) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 16);
goto error;
}
#endif
if (!(ppb_rstr(bus) & SELECT)) {
ppb_peripheral_terminate(bus, PPB_WAIT);
goto error;
}
error:
return (error);
}
int
byte_peripheral_write(device_t bus, char *buffer, int len, int *sent)
{
int error = 0, i;
char r;
ppb_1284_set_state(bus, PPB_PERIPHERAL_TRANSFER);
for (i=0; i<len; i++) {
r = ppb_rctr(bus);
ppb_wctr(bus, r & ~nINIT);
#ifdef DEBUG_1284
kprintf("y");
#endif
error = ppb_poll_bus(bus, PPB_FOREVER, nBUSY, nBUSY,
PPB_INTR);
if (error && error != EWOULDBLOCK)
goto error;
#ifdef DEBUG_1284
kprintf("b");
#endif
if ((error = byte_peripheral_outbyte(bus, buffer+i, (i == len-1))))
goto error;
}
error:
if (!error)
ppb_1284_set_state(bus, PPB_PERIPHERAL_IDLE);
*sent = i;
return (error);
}
int
byte_1284_inbyte(device_t bus, char *buffer)
{
int error = 0;
ppb_wctr(bus, (PCD | nINIT | AUTOFEED) & ~(STROBE | SELECTIN));
if ((error = do_1284_wait(bus, nACK, 0))) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 9);
goto error;
}
*buffer = ppb_rdtr(bus);
ppb_wctr(bus, (nINIT) & ~(AUTOFEED | STROBE | SELECTIN));
if ((error = do_1284_wait(bus, nACK, nACK))) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 11);
goto error;
}
ppb_wctr(bus, (nINIT | STROBE) & ~(AUTOFEED | SELECTIN));
DELAY(3);
ppb_wctr(bus, (nINIT) & ~(AUTOFEED | STROBE | SELECTIN));
error:
return (error);
}
int
nibble_1284_inbyte(device_t bus, char *buffer)
{
char nibble[2];
int i, error;
for (i = 0; i < 2; i++) {
ppb_wctr(bus, (nINIT | AUTOFEED) & ~(STROBE | SELECTIN));
if ((error = do_1284_wait(bus, nACK, 0))) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 9);
goto error;
}
nibble[i] = ppb_rstr(bus);
ppb_wctr(bus, nINIT & ~(AUTOFEED | STROBE | SELECTIN));
if ((error = do_1284_wait(bus, nACK, nACK))) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 11);
goto error;
}
}
*buffer = ((nibble2char(nibble[1]) << 4) & 0xf0) |
(nibble2char(nibble[0]) & 0x0f);
error:
return (error);
}
int
spp_1284_read(device_t bus, int mode, char *buffer, int max, int *read)
{
int error = 0, len = 0;
int terminate_after_transfer = 1;
int state;
*read = len = 0;
state = ppb_1284_get_state(bus);
switch (state) {
case PPB_FORWARD_IDLE:
if ((error = ppb_1284_negotiate(bus, mode, 0)))
return (error);
break;
case PPB_REVERSE_IDLE:
terminate_after_transfer = 0;
break;
default:
ppb_1284_terminate(bus);
if ((error = ppb_1284_negotiate(bus, mode, 0)))
return (error);
break;
}
while ((len < max) && !(ppb_rstr(bus) & (nFAULT))) {
ppb_1284_set_state(bus, PPB_REVERSE_TRANSFER);
#ifdef DEBUG_1284
kprintf("B");
#endif
switch (mode) {
case PPB_NIBBLE:
if (nibble_1284_inbyte(bus, buffer+len))
goto end_while;
break;
case PPB_BYTE:
if (byte_1284_inbyte(bus, buffer+len))
goto end_while;
break;
default:
error = EINVAL;
goto end_while;
}
len ++;
}
end_while:
if (!error)
ppb_1284_set_state(bus, PPB_REVERSE_IDLE);
*read = len;
if (terminate_after_transfer || error)
ppb_1284_terminate(bus);
return (error);
}
int
ppb_1284_read_id(device_t bus, int mode, char *buffer,
int max, int *read)
{
int error = 0;
bzero(buffer, max);
switch (mode) {
case PPB_NIBBLE:
case PPB_ECP:
if ((error = ppb_1284_negotiate(bus, PPB_NIBBLE, PPB_REQUEST_ID)))
return (error);
error = spp_1284_read(bus, PPB_NIBBLE, buffer, max, read);
break;
case PPB_BYTE:
if ((error = ppb_1284_negotiate(bus, PPB_BYTE, PPB_REQUEST_ID)))
return (error);
error = spp_1284_read(bus, PPB_BYTE, buffer, max, read);
break;
default:
panic("%s: unsupported mode %d", __func__, mode);
}
ppb_1284_terminate(bus);
return (error);
}
int
ppb_1284_read(device_t bus, int mode, char *buffer,
int max, int *read)
{
int error = 0;
switch (mode) {
case PPB_NIBBLE:
case PPB_BYTE:
error = spp_1284_read(bus, mode, buffer, max, read);
break;
default:
return (EINVAL);
}
return (error);
}
int
ppb_1284_negotiate(device_t bus, int mode, int options)
{
int error;
int request_mode;
#ifdef DEBUG_1284
kprintf("n");
#endif
if (ppb_1284_get_state(bus) >= PPB_PERIPHERAL_NEGOTIATION)
ppb_peripheral_terminate(bus, PPB_WAIT);
if (ppb_1284_get_state(bus) != PPB_FORWARD_IDLE)
ppb_1284_terminate(bus);
#ifdef DEBUG_1284
kprintf("%d", mode);
#endif
ppb_set_mode(bus, PPB_COMPATIBLE);
ppb_1284_reset_error(bus, PPB_FORWARD_IDLE);
request_mode = ppb_request_mode(mode, options);
ppb_wctr(bus, (nINIT | SELECTIN) & ~(STROBE | AUTOFEED));
DELAY(1);
ppb_1284_set_state(bus, PPB_NEGOTIATION);
ppb_wdtr(bus, request_mode);
#ifdef PERIPH_1284
ppb_wctr(bus, (nINIT | STROBE) & ~(AUTOFEED | SELECTIN));
DELAY(1);
ppb_wctr(bus, (nINIT) & ~(STROBE | AUTOFEED | SELECTIN));
#else
DELAY(1);
#endif
ppb_wctr(bus, (nINIT | AUTOFEED) & ~(STROBE | SELECTIN));
#ifdef PERIPH_1284
if (ppb_poll_bus(bus, 40, nACK | SELECT | nFAULT,
SELECT | nFAULT, PPB_NOINTR | PPB_POLL)) {
ppb_1284_set_error(bus, PPB_NOT_IEEE1284, 2);
error = ENODEV;
goto error;
}
#else
if (do_1284_wait(bus, nACK | PERROR | SELECT | nFAULT,
PERROR | SELECT | nFAULT)) {
ppb_1284_set_error(bus, PPB_NOT_IEEE1284, 2);
error = ENODEV;
goto error;
}
#endif
ppb_wctr(bus, (nINIT | STROBE | AUTOFEED) & ~SELECTIN);
DELAY(1);
ppb_wctr(bus, nINIT & ~(SELECTIN | AUTOFEED | STROBE));
if (do_1284_wait(bus, nACK, nACK)) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 6);
error = EBUSY;
goto error;
}
if (options & PPB_EXTENSIBILITY_LINK) {
ppb_1284_terminate(bus);
return (0);
}
if (request_mode == NIBBLE_1284_NORMAL) {
if (do_1284_wait(bus, nACK | SELECT, nACK)) {
ppb_1284_set_error(bus, PPB_MODE_UNSUPPORTED, 7);
error = ENODEV;
goto error;
}
} else {
if (do_1284_wait(bus, nACK | SELECT, SELECT | nACK)) {
ppb_1284_set_error(bus, PPB_MODE_UNSUPPORTED, 7);
error = ENODEV;
goto error;
}
}
switch (mode) {
case PPB_NIBBLE:
case PPB_PS2:
ppb_1284_set_state(bus, PPB_REVERSE_IDLE);
break;
case PPB_ECP:
ppb_1284_set_state(bus, PPB_SETUP);
ppb_wctr(bus, (nINIT | AUTOFEED) & ~(SELECTIN | STROBE));
#ifdef PERIPH_1284
if (do_1284_wait(bus, nACK | SELECT | nBUSY,
nACK | SELECT | nBUSY)) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 30);
error = ENODEV;
goto error;
}
#else
if (do_1284_wait(bus, nACK | SELECT | PERROR | nBUSY,
nACK | SELECT | PERROR | nBUSY)) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 30);
error = ENODEV;
goto error;
}
#endif
ppb_1284_set_state(bus, PPB_ECP_FORWARD_IDLE);
break;
case PPB_EPP:
ppb_1284_set_state(bus, PPB_EPP_IDLE);
break;
default:
panic("%s: unknown mode (%d)!", __func__, mode);
}
ppb_set_mode(bus, mode);
return (0);
error:
ppb_1284_terminate(bus);
return (error);
}
int
ppb_1284_terminate(device_t bus)
{
#ifdef DEBUG_1284
kprintf("T");
#endif
ppb_1284_set_state(bus, PPB_TERMINATION);
#ifdef PERIPH_1284
ppb_wctr(bus, (nINIT | STROBE | SELECTIN) & ~(AUTOFEED));
DELAY(1);
#endif
ppb_wctr(bus, (nINIT | SELECTIN) & ~(STROBE | AUTOFEED));
if (do_1284_wait(bus, nACK | nBUSY | nFAULT, nFAULT)) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 24);
goto error;
}
ppb_wctr(bus, (nINIT | SELECTIN | AUTOFEED) & ~STROBE);
if (do_1284_wait(bus, nACK, nACK)) {
ppb_1284_set_error(bus, PPB_TIMEOUT, 27);
}
ppb_wctr(bus, (nINIT | SELECTIN) & ~(STROBE | AUTOFEED));
error:
ppb_set_mode(bus, PPB_COMPATIBLE);
ppb_1284_set_state(bus, PPB_FORWARD_IDLE);
return (0);
}