#ifdef __NetBSD__
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: adb_direct.c,v 1.75 2026/06/14 02:03:57 thorpej Exp $");
#include "opt_adb.h"
#include <sys/param.h>
#include <sys/pool.h>
#include <sys/queue.h>
#include <sys/systm.h>
#include <sys/callout.h>
#include <sys/cpu.h>
#include <sys/intr.h>
#include <machine/viareg.h>
#include <machine/adbsys.h>
#include <machine/iopreg.h>
#include <m68k/vectors.h>
#include <mac68k/mac68k/macrom.h>
#include <mac68k/dev/adbvar.h>
#define printf_intr printf
#else
#include "via.h"
#define ADB_HW_UNKNOWN 0x0
#define ADB_HW_II 0x1
#define ADB_HW_IISI 0x2
#define ADB_HW_PB 0x3
#define ADB_HW_CUDA 0x4
#endif
#define vPB 0x0000
#define vPB3 0x08
#define vPB4 0x10
#define vPB5 0x20
#define vSR_INT 0x04
#define vSR_OUT 0x10
#define ADB_ACTION_NOTREADY 0x1
#define ADB_ACTION_IDLE 0x2
#define ADB_ACTION_OUT 0x3
#define ADB_ACTION_IN 0x4
#define ADB_ACTION_POLLING 0x5
#define ADB_ACTION_RUNNING 0x6
#define ADB_BUS_UNKNOWN 0x1
#define ADB_BUS_IDLE 0x2
#define ADB_BUS_CMD 0x3
#define ADB_BUS_ODD 0x4
#define ADB_BUS_EVEN 0x5
#define ADB_BUS_ACTIVE 0x6
#define ADB_BUS_ACK 0x7
#define ADB_SET_STATE_IDLE_II() via_reg(VIA1, vBufB) |= (vPB4 | vPB5)
#define ADB_SET_STATE_IDLE_IISI() via_reg(VIA1, vBufB) &= ~(vPB4 | vPB5)
#define ADB_SET_STATE_IDLE_CUDA() via_reg(VIA1, vBufB) |= (vPB4 | vPB5)
#define ADB_SET_STATE_CMD() via_reg(VIA1, vBufB) &= ~(vPB4 | vPB5)
#define ADB_SET_STATE_EVEN() via_reg(VIA1, vBufB) = ((via_reg(VIA1, \
vBufB) | vPB4) & ~vPB5)
#define ADB_SET_STATE_ODD() via_reg(VIA1, vBufB) = ((via_reg(VIA1, \
vBufB) | vPB5) & ~vPB4)
#define ADB_SET_STATE_ACTIVE() via_reg(VIA1, vBufB) |= vPB5
#define ADB_SET_STATE_INACTIVE() via_reg(VIA1, vBufB) &= ~vPB5
#define ADB_SET_STATE_TIP() via_reg(VIA1, vBufB) &= ~vPB5
#define ADB_CLR_STATE_TIP() via_reg(VIA1, vBufB) |= vPB5
#define ADB_SET_STATE_ACKON() via_reg(VIA1, vBufB) |= vPB4
#define ADB_SET_STATE_ACKOFF() via_reg(VIA1, vBufB) &= ~vPB4
#define ADB_TOGGLE_STATE_ACK_CUDA() via_reg(VIA1, vBufB) ^= vPB4
#define ADB_SET_STATE_ACKON_CUDA() via_reg(VIA1, vBufB) &= ~vPB4
#define ADB_SET_STATE_ACKOFF_CUDA() via_reg(VIA1, vBufB) |= vPB4
#define ADB_SET_SR_INPUT() via_reg(VIA1, vACR) &= ~vSR_OUT
#define ADB_SET_SR_OUTPUT() via_reg(VIA1, vACR) |= vSR_OUT
#define ADB_SR() via_reg(VIA1, vSR)
#define ADB_VIA_INTR_ENABLE() via_reg(VIA1, vIER) = 0x84
#define ADB_VIA_INTR_DISABLE() via_reg(VIA1, vIER) = 0x04
#define ADB_VIA_CLR_INTR() via_reg(VIA1, vIFR) = 0x04
#define ADB_INTR_IS_OFF (vPB3 == (via_reg(VIA1, vBufB) & vPB3))
#define ADB_INTR_IS_ON (0 == (via_reg(VIA1, vBufB) & vPB3))
#define ADB_SR_INTR_IS_OFF (0 == (via_reg(VIA1, vIFR) & vSR_INT))
#define ADB_SR_INTR_IS_ON (vSR_INT == (via_reg(VIA1, \
vIFR) & vSR_INT))
#define ADB_DELAY 150
#define ADB_MAX_MSG_LENGTH 16
#define ADB_MAX_HDR_LENGTH 8
#define ADB_QUEUE 32
#define ADB_TICKLE_TICKS 4
struct ADBDevEntry {
void (*ServiceRtPtr)(void);
void *DataAreaAddr;
int devType;
int origAddr;
int currentAddr;
};
struct adbCmdHoldEntry {
u_char outBuf[ADB_MAX_MSG_LENGTH];
u_char *saveBuf;
u_char *compRout;
u_char *data;
};
struct adbCommand {
u_char header[ADB_MAX_HDR_LENGTH];
u_char data[ADB_MAX_MSG_LENGTH];
u_char *saveBuf;
u_char *compRout;
u_char *compData;
u_int cmd;
u_int unsol;
u_int ack_only;
};
const char *adbHardwareDescr[MAX_ADB_HW + 1] = {
"unknown",
"II series",
"IIsi series",
"PowerBook",
"Cuda",
"IOP",
};
int adbHardware = ADB_HW_UNKNOWN;
int adbActionState = ADB_ACTION_NOTREADY;
int adbBusState = ADB_BUS_UNKNOWN;
int adbWaiting = 0;
int adbWriteDelay = 0;
int adbOutQueueHasData = 0;
int adbNextEnd = 0;
int adbSoftPower = 0;
int adbWaitingCmd = 0;
u_char *adbBuffer = (long)0;
void *adbCompRout = (long)0;
void *adbCompData = (long)0;
long adbFakeInts = 0;
int adbStarting = 1;
int adbSendTalk = 0;
int adbPolling = 0;
int adbPollCmd = 0;
u_char adbInputBuffer[ADB_MAX_MSG_LENGTH];
u_char adbOutputBuffer[ADB_MAX_MSG_LENGTH];
struct adbCmdHoldEntry adbOutQueue;
int adbSentChars = 0;
int adbLastDevice = 0;
int adbLastDevIndex = 0;
int adbLastCommand = 0;
struct ADBDevEntry ADBDevTable[16];
int ADBNumDevices;
struct adbCommand adbInbound[ADB_QUEUE];
volatile int adbInCount = 0;
int adbInHead = 0;
int adbInTail = 0;
struct adbCommand adbOutbound[ADB_QUEUE];
int adbOutCount = 0;
int adbOutHead = 0;
int adbOutTail = 0;
int tickle_count = 0;
int tickle_serial = 0;
int adb_cuda_serial = 0;
callout_t adb_cuda_tickle_ch;
void *adb_softintr_cookie;
extern struct mac68k_machine_S mac68k_machine;
void pm_setup_adb(void);
void pm_hw_setup(void);
void pm_check_adb_devices(int);
void pm_intr(void *);
int pm_adb_op(u_char *, void *, void *, int);
void pm_init_adb_device(void);
#ifdef ADB_DEBUG
void print_single(u_char *);
#endif
void adb_intr(void *);
void adb_intr_II(void *);
void adb_intr_IIsi(void *);
void adb_intr_cuda(void *);
void adb_soft_intr(void);
int send_adb_II(u_char *, u_char *, void *, void *, int);
int send_adb_IIsi(u_char *, u_char *, void *, void *, int);
int send_adb_cuda(u_char *, u_char *, void *, void *, int);
void adb_intr_cuda_test(void);
void adb_cuda_tickle(void);
void adb_pass_up(struct adbCommand *);
void adb_op_comprout(void);
void adb_reinit(void);
int count_adbs(void);
int get_ind_adb_info(ADBDataBlock *, int);
int get_adb_info(ADBDataBlock *, int);
int set_adb_info(ADBSetInfoBlock *, int);
void adb_setup_hw_type(void);
int adb_op(Ptr, Ptr, Ptr, short);
void adb_read_II(u_char *);
void adb_hw_setup(void);
void adb_hw_setup_IIsi(u_char *);
void adb_comp_exec(void);
int adb_cmd_result(u_char *);
int adb_cmd_extra(u_char *);
int adb_guess_next_device(void);
int adb_prog_switch_enable(void);
int adb_prog_switch_disable(void);
int send_adb(u_char *, void *, void *);
void adb_iop_recv(IOP *, struct iop_msg *);
int send_adb_iop(int, u_char *, void *, void *);
#ifdef ADB_DEBUG
void
print_single(u_char *str)
{
int x;
if (str == 0) {
printf_intr("no data - null pointer\n");
return;
}
if (*str == 0) {
printf_intr("nothing returned\n");
return;
}
if (*str > 20) {
printf_intr("ADB: ACK > 20 no way!\n");
*str = (u_char)20;
}
printf_intr("(length=0x%x):", (u_int)*str);
for (x = 1; x <= *str; x++)
printf_intr(" 0x%02x", (u_int)*(str + x));
printf_intr("\n");
}
#endif
static inline void
adb_process_serial_intrs(void)
{
struct clockframe dummy_frame = {
.cf_sr = PSL_S,
.cf_vo = VECI_TO_VECO(VECI_INTRAV4),
};
(void)intr_dispatch(dummy_frame);
}
void
adb_cuda_tickle(void)
{
volatile int s;
if (adbActionState == ADB_ACTION_IN) {
if (tickle_serial == adb_cuda_serial) {
if (++tickle_count > 0) {
s = splhigh();
adbActionState = ADB_ACTION_IDLE;
adbInputBuffer[0] = 0;
ADB_SET_STATE_IDLE_CUDA();
splx(s);
}
} else {
tickle_serial = adb_cuda_serial;
tickle_count = 0;
}
} else {
tickle_serial = adb_cuda_serial;
tickle_count = 0;
}
callout_reset(&adb_cuda_tickle_ch, ADB_TICKLE_TICKS,
(void *)adb_cuda_tickle, NULL);
}
void
adb_intr_cuda(void *arg)
{
volatile int i __unused, ending;
volatile unsigned int s;
struct adbCommand packet;
s = splhigh();
ADB_VIA_CLR_INTR();
ADB_VIA_INTR_DISABLE();
switch_start:
switch (adbActionState) {
case ADB_ACTION_IDLE:
adbInputBuffer[1] = ADB_SR();
adb_cuda_serial++;
if (ADB_INTR_IS_OFF)
break;
ADB_SET_SR_INPUT();
ADB_SET_STATE_TIP();
adbInputBuffer[0] = 1;
adbActionState = ADB_ACTION_IN;
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("idle 0x%02x ", adbInputBuffer[1]);
#endif
break;
case ADB_ACTION_IN:
adbInputBuffer[++adbInputBuffer[0]] = ADB_SR();
if (ADB_INTR_IS_OFF)
ending = 1;
else
ending = 0;
if (1 == ending) {
#ifdef ADB_DEBUG
if (adb_debug) {
printf_intr("in end 0x%02x ",
adbInputBuffer[adbInputBuffer[0]]);
print_single(adbInputBuffer);
}
#endif
memcpy(packet.data, adbInputBuffer, adbInputBuffer[0] + 1);
if ((adbWaiting == 1) &&
(adbInputBuffer[4] == adbWaitingCmd) &&
((adbInputBuffer[2] == 0x00) ||
(adbInputBuffer[2] == 0x01))) {
packet.saveBuf = adbBuffer;
packet.compRout = adbCompRout;
packet.compData = adbCompData;
packet.unsol = 0;
packet.ack_only = 0;
adb_pass_up(&packet);
adbWaitingCmd = 0;
adbWaiting = 0;
adbBuffer = (long)0;
adbCompRout = (long)0;
adbCompData = (long)0;
} else {
packet.unsol = 1;
packet.ack_only = 0;
adb_pass_up(&packet);
}
adbActionState = ADB_ACTION_IDLE;
adbInputBuffer[0] = 0;
ADB_SET_STATE_IDLE_CUDA();
if (adbWriteDelay == 1) {
delay(ADB_DELAY);
adbSentChars = 0;
adbActionState = ADB_ACTION_OUT;
if (ADB_INTR_IS_ON) {
ADB_SET_SR_INPUT();
ADB_SET_STATE_IDLE_CUDA();
adbSentChars = 0;
adbActionState = ADB_ACTION_IDLE;
adbInputBuffer[0] = 0;
break;
}
ADB_SET_STATE_TIP();
ADB_SET_SR_OUTPUT();
ADB_SR() = adbOutputBuffer[adbSentChars + 1];
}
} else {
ADB_TOGGLE_STATE_ACK_CUDA();
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("in 0x%02x ",
adbInputBuffer[adbInputBuffer[0]]);
#endif
}
break;
case ADB_ACTION_OUT:
i = ADB_SR();
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("intr out 0x%02x ", i);
#endif
adbSentChars++;
if (ADB_INTR_IS_ON) {
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("intr was on ");
#endif
ADB_SET_SR_INPUT();
ADB_SET_STATE_IDLE_CUDA();
adbSentChars = 0;
adbActionState = ADB_ACTION_IDLE;
adbInputBuffer[0] = 0;
adbWriteDelay = 1;
delay(ADB_DELAY);
goto switch_start;
break;
}
if (adbOutputBuffer[0] == adbSentChars) {
if (0 == adb_cmd_result(adbOutputBuffer)) {
adbWaiting = 1;
adbWaitingCmd = adbOutputBuffer[2];
} else {
memcpy(packet.data, adbInputBuffer, adbInputBuffer[0] + 1);
packet.saveBuf = adbBuffer;
packet.compRout = adbCompRout;
packet.compData = adbCompData;
packet.cmd = adbWaitingCmd;
packet.unsol = 0;
packet.ack_only = 1;
adb_pass_up(&packet);
adbWaitingCmd = 0;
adbBuffer = (long)0;
adbCompRout = (long)0;
adbCompData = (long)0;
}
adbWriteDelay = 0;
adbActionState = ADB_ACTION_IDLE;
ADB_SET_SR_INPUT();
ADB_SET_STATE_IDLE_CUDA();
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("write done ");
#endif
} else {
ADB_SR() = adbOutputBuffer[adbSentChars + 1];
ADB_TOGGLE_STATE_ACK_CUDA();
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("toggle ");
#endif
}
break;
case ADB_ACTION_NOTREADY:
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("adb: not yet initialized\n");
#endif
break;
default:
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("intr: unknown ADB state\n");
#endif
break;
}
ADB_VIA_INTR_ENABLE();
splx(s);
return;
}
int
send_adb_cuda(u_char *in, u_char *buffer, void *compRout, void *data, int
command)
{
int s, len;
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("SEND\n");
#endif
if (adbActionState == ADB_ACTION_NOTREADY)
return 1;
s = splhigh();
if ((adbActionState == ADB_ACTION_IDLE) &&
(ADB_INTR_IS_OFF)) {
} else
if (adbWriteDelay == 0)
adbWriteDelay = 1;
else {
splx(s);
return 1;
}
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("QUEUE\n");
#endif
if ((long)in == (long)0) {
if ((command & 0x0c) == 0x08)
len = buffer[0];
else
len = 0;
adbOutputBuffer[0] = 2 + len;
adbOutputBuffer[1] = 0x00;
adbOutputBuffer[2] = (u_char)command;
memcpy(adbOutputBuffer + 3, buffer + 1, len);
} else
memcpy(adbOutputBuffer, in, in[0] + 2);
adbSentChars = 0;
adbBuffer = buffer;
adbCompRout = compRout;
adbCompData = data;
adbWaitingCmd = adbOutputBuffer[2];
if (adbWriteDelay != 1) {
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("out start NOW");
#endif
delay(ADB_DELAY);
adbActionState = ADB_ACTION_OUT;
ADB_SET_SR_OUTPUT();
ADB_SR() = adbOutputBuffer[adbSentChars + 1];
ADB_SET_STATE_ACKOFF_CUDA();
ADB_SET_STATE_TIP();
}
adbWriteDelay = 1;
splx(s);
if (0x0100 <= (s & 0x0700))
while ((adbActionState != ADB_ACTION_IDLE) || (ADB_INTR_IS_ON)
|| (adbWaiting == 1))
if (ADB_SR_INTR_IS_ON) {
adb_intr_cuda(NULL);
if (adb_polling)
adb_soft_intr();
}
return 0;
}
void
adb_intr_II(void *arg)
{
struct adbCommand packet;
int i, intr_on = 0;
int send = 0;
unsigned int s;
s = splhigh();
ADB_VIA_CLR_INTR();
ADB_VIA_INTR_DISABLE();
delay(ADB_DELAY);
adb_process_serial_intrs();
if (ADB_INTR_IS_ON)
intr_on = 1;
switch_start:
switch (adbActionState) {
case ADB_ACTION_POLLING:
if (!intr_on) {
if (adbOutQueueHasData) {
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("POLL-doing-out-queue. ");
#endif
ADB_SET_STATE_IDLE_II();
delay(ADB_DELAY);
memcpy(adbOutputBuffer, adbOutQueue.outBuf,
adbOutQueue.outBuf[0] + 2);
adbBuffer = adbOutQueue.saveBuf;
adbCompRout = adbOutQueue.compRout;
adbCompData = adbOutQueue.data;
adbOutQueueHasData = 0;
adbSentChars = 0;
adbActionState = ADB_ACTION_OUT;
ADB_SET_SR_OUTPUT();
ADB_SR() = adbOutputBuffer[1];
adbBusState = ADB_BUS_CMD;
ADB_SET_STATE_CMD();
break;
} else {
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("pIDLE ");
#endif
adbActionState = ADB_ACTION_IDLE;
}
} else {
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("pIN ");
#endif
adbActionState = ADB_ACTION_IN;
}
delay(ADB_DELAY);
adb_process_serial_intrs();
goto switch_start;
break;
case ADB_ACTION_IDLE:
if (!intr_on) {
i = ADB_SR();
adbBusState = ADB_BUS_IDLE;
adbActionState = ADB_ACTION_IDLE;
ADB_SET_STATE_IDLE_II();
delay(ADB_DELAY);
break;
}
adbInputBuffer[0] = 1;
adbInputBuffer[1] = ADB_SR();
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("idle 0x%02x ", adbInputBuffer[1]);
#endif
ADB_SET_SR_INPUT();
adbActionState = ADB_ACTION_IN;
ADB_SET_STATE_EVEN();
adbBusState = ADB_BUS_EVEN;
break;
case ADB_ACTION_IN:
adbInputBuffer[++adbInputBuffer[0]] = ADB_SR();
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("in 0x%02x ",
adbInputBuffer[adbInputBuffer[0]]);
#endif
ADB_SET_SR_INPUT();
if (intr_on) {
adbInputBuffer[0]--;
if (adbInputBuffer[0] == 2) {
adbInputBuffer[0]++;
}
#ifdef ADB_DEBUG
if (adb_debug & 0x80) {
printf_intr("done: ");
print_single(adbInputBuffer);
}
#endif
adbLastDevice = ADB_CMDADDR(adbInputBuffer[1]);
if (adbInputBuffer[0] == 1 && !adbWaiting) {
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr(" xSRQ! ");
#endif
adb_guess_next_device();
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("try 0x%0x ",
adbLastDevice);
#endif
adbOutputBuffer[0] = 1;
adbOutputBuffer[1] = ADBTALK(adbLastDevice, 0);
adbSentChars = 0;
adbActionState = ADB_ACTION_POLLING;
ADB_SET_SR_OUTPUT();
ADB_SR() = adbOutputBuffer[1];
adbBusState = ADB_BUS_CMD;
ADB_SET_STATE_CMD();
break;
}
memcpy(packet.data, adbInputBuffer, adbInputBuffer[0] + 1);
if (!adbWaiting && (adbInputBuffer[0] != 0)) {
packet.unsol = 1;
packet.ack_only = 0;
adb_pass_up(&packet);
} else {
packet.saveBuf = adbBuffer;
packet.compRout = adbCompRout;
packet.compData = adbCompData;
packet.unsol = 0;
packet.ack_only = 0;
adb_pass_up(&packet);
}
adbWaiting = 0;
adbInputBuffer[0] = 0;
adbBuffer = (long)0;
adbCompRout = (long)0;
adbCompData = (long)0;
if (adbOutQueueHasData == 1) {
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("XXX: DOING OUT QUEUE\n");
#endif
memcpy(adbOutputBuffer, adbOutQueue.outBuf,
adbOutQueue.outBuf[0] + 2);
adbBuffer = adbOutQueue.saveBuf;
adbCompRout = adbOutQueue.compRout;
adbCompData = adbOutQueue.data;
adbOutQueueHasData = 0;
send = 1;
} else {
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("XXending ");
#endif
adb_guess_next_device();
adbOutputBuffer[0] = 1;
adbOutputBuffer[1] = ((adbLastDevice & 0x0f) << 4) | 0x0c;
adbSentChars = 0;
adbActionState = ADB_ACTION_POLLING;
ADB_SET_SR_OUTPUT();
ADB_SR() = adbOutputBuffer[1];
adbBusState = ADB_BUS_CMD;
ADB_SET_STATE_CMD();
break;
}
}
if (send) {
adbSentChars = 0;
adbActionState = ADB_ACTION_OUT;
ADB_SET_SR_OUTPUT();
ADB_SR() = adbOutputBuffer[1];
adbBusState = ADB_BUS_CMD;
ADB_SET_STATE_CMD();
break;
}
switch (adbBusState) {
case ADB_BUS_EVEN:
ADB_SET_STATE_ODD();
adbBusState = ADB_BUS_ODD;
break;
case ADB_BUS_ODD:
ADB_SET_STATE_EVEN();
adbBusState = ADB_BUS_EVEN;
break;
default:
printf_intr("strange state!!!\n");
break;
}
break;
case ADB_ACTION_OUT:
i = ADB_SR();
adbSentChars++;
if ((adbOutputBuffer[1] & 0x0c) == 0x0c) {
adbInputBuffer[0] = 1;
adbInputBuffer[1] = i;
adbActionState = ADB_ACTION_IN;
ADB_SET_SR_INPUT();
adbBusState = ADB_BUS_EVEN;
ADB_SET_STATE_EVEN();
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("talk out 0x%02x ", i);
#endif
adbWaiting = 1;
break;
}
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("non-talk out 0x%0x ", i);
#endif
ADB_SET_SR_OUTPUT();
if (adbOutputBuffer[0] == adbSentChars) {
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("done \n");
#endif
memcpy(packet.data, adbOutputBuffer, adbOutputBuffer[0] + 1);
packet.saveBuf = adbBuffer;
packet.compRout = adbCompRout;
packet.compData = adbCompData;
packet.cmd = adbWaitingCmd;
packet.unsol = 0;
packet.ack_only = 1;
adb_pass_up(&packet);
adbBuffer = (long)0;
adbCompRout = (long)0;
adbCompData = (long)0;
if (adbOutQueueHasData == 1) {
memcpy(adbOutputBuffer, adbOutQueue.outBuf,
adbOutQueue.outBuf[0] + 2);
adbBuffer = adbOutQueue.saveBuf;
adbCompRout = adbOutQueue.compRout;
adbCompData = adbOutQueue.data;
adbOutQueueHasData = 0;
adbSentChars = 0;
adbActionState = ADB_ACTION_OUT;
ADB_SET_SR_OUTPUT();
ADB_SR() = adbOutputBuffer[1];
adbBusState = ADB_BUS_CMD;
ADB_SET_STATE_CMD();
break;
} else {
adbOutputBuffer[0] = 1;
adbOutputBuffer[1] =
ADBTALK(ADB_CMDADDR(adbOutputBuffer[1]), 0);
adbSentChars = 0;
adbActionState = ADB_ACTION_IDLE;
ADB_SET_SR_OUTPUT();
ADB_SR() = adbOutputBuffer[1];
adbBusState = ADB_BUS_CMD;
ADB_SET_STATE_CMD();
break;
}
}
ADB_SR() = adbOutputBuffer[adbSentChars + 1];
switch (adbBusState) {
case ADB_BUS_EVEN:
ADB_SET_STATE_ODD();
adbBusState = ADB_BUS_ODD;
break;
case ADB_BUS_CMD:
case ADB_BUS_ODD:
ADB_SET_STATE_EVEN();
adbBusState = ADB_BUS_EVEN;
break;
default:
#ifdef ADB_DEBUG
if (adb_debug) {
printf_intr("strange state!!! (0x%x)\n",
adbBusState);
}
#endif
break;
}
break;
default:
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("adb: unknown ADB state (during intr)\n");
#endif
break;
}
ADB_VIA_INTR_ENABLE();
splx(s);
return;
}
int
send_adb_II(u_char *in, u_char *buffer, void *compRout, void *data, int command)
{
int s, len;
if (adbActionState == ADB_ACTION_NOTREADY)
return 1;
s = splhigh();
if (0 != adbOutQueueHasData) {
splx(s);
return 1;
}
if ((long)in == (long)0) {
if ((command & 0x0c) == 0x08)
len = buffer[0];
else
len = 0;
adbOutQueue.outBuf[0] = 1 + len;
adbOutQueue.outBuf[1] = (u_char)command;
memcpy(adbOutQueue.outBuf + 2, buffer + 1, len);
} else
memcpy(adbOutQueue.outBuf, in, in[0] + 2);
adbOutQueue.saveBuf = buffer;
adbOutQueue.compRout = compRout;
adbOutQueue.data = data;
if ((adbActionState == ADB_ACTION_IDLE) &&
(ADB_INTR_IS_OFF)) {
memcpy(adbOutputBuffer, adbOutQueue.outBuf,
adbOutQueue.outBuf[0] + 2);
adbBuffer = adbOutQueue.saveBuf;
adbCompRout = adbOutQueue.compRout;
adbCompData = adbOutQueue.data;
adbSentChars = 0;
adbActionState = ADB_ACTION_OUT;
adbBusState = ADB_BUS_CMD;
ADB_SET_SR_OUTPUT();
ADB_SR() = adbOutputBuffer[adbSentChars + 1];
ADB_SET_STATE_CMD();
adbOutQueueHasData = 0;
} else
adbOutQueueHasData = 1;
splx(s);
if (0x0100 <= (s & 0x0700))
while ((adbActionState != ADB_ACTION_IDLE) || (ADB_INTR_IS_ON)
|| (adbWaiting == 1))
if (ADB_SR_INTR_IS_ON) {
adb_intr_II(NULL);
if (adb_polling)
adb_soft_intr();
}
return 0;
}
int
adb_guess_next_device(void)
{
int last, i, dummy;
if (adbStarting) {
if (adbLastDevice < 1 || adbLastDevice > 15)
adbLastDevice = 1;
if (++adbLastDevice > 15)
adbLastDevice = 1;
} else {
if (adbLastDevice < 1 || adbLastDevice > 15)
adbLastDevice = 2;
last = 1;
for (i = 1; i < 16; i++)
if (ADBDevTable[i].currentAddr == adbLastDevice) {
last = i;
break;
}
dummy = last;
for (;;) {
if (++dummy > 15)
dummy = 1;
if (dummy == last) {
dummy = 1;
break;
}
if (ADBDevTable[dummy].devType != 0)
break;
}
adbLastDevice = ADBDevTable[dummy].currentAddr;
}
return adbLastDevice;
}
void
adb_intr(void *arg)
{
switch (adbHardware) {
case ADB_HW_II:
adb_intr_II(arg);
break;
case ADB_HW_IISI:
adb_intr_IIsi(arg);
break;
case ADB_HW_PB:
break;
case ADB_HW_CUDA:
adb_intr_cuda(arg);
break;
case ADB_HW_IOP:
break;
case ADB_HW_UNKNOWN:
break;
}
}
void
adb_intr_IIsi(void *arg)
{
struct adbCommand packet;
int ending;
unsigned int s;
s = splhigh();
ADB_VIA_CLR_INTR();
ADB_VIA_INTR_DISABLE();
switch_start:
switch (adbActionState) {
case ADB_ACTION_IDLE:
delay(ADB_DELAY);
ADB_SET_SR_INPUT();
ADB_SET_STATE_ACTIVE();
adbInputBuffer[1] = ADB_SR();
adbInputBuffer[0] = 1;
adbActionState = ADB_ACTION_IN;
ADB_SET_STATE_ACKON();
delay(ADB_DELAY);
ADB_SET_STATE_ACKOFF();
adb_process_serial_intrs();
break;
case ADB_ACTION_IN:
ADB_SET_SR_INPUT();
adbInputBuffer[++adbInputBuffer[0]] = ADB_SR();
if (ADB_INTR_IS_OFF)
ending = 1;
else
ending = 0;
ADB_SET_STATE_ACKON();
delay(ADB_DELAY);
ADB_SET_STATE_ACKOFF();
adb_process_serial_intrs();
if (1 == ending) {
ADB_SET_STATE_INACTIVE();
memcpy(packet.data, adbInputBuffer, adbInputBuffer[0] + 1);
if ((adbWaiting == 1) &&
(adbInputBuffer[4] == adbWaitingCmd) &&
((adbInputBuffer[2] == 0x00) ||
(adbInputBuffer[2] == 0x01))) {
packet.saveBuf = adbBuffer;
packet.compRout = adbCompRout;
packet.compData = adbCompData;
packet.unsol = 0;
packet.ack_only = 0;
adb_pass_up(&packet);
adbWaitingCmd = 0;
adbWaiting = 0;
adbBuffer = (long)0;
adbCompRout = (long)0;
adbCompData = (long)0;
} else {
packet.unsol = 1;
packet.ack_only = 0;
adb_pass_up(&packet);
}
adbActionState = ADB_ACTION_IDLE;
adbInputBuffer[0] = 0;
if (adbWriteDelay == 1) {
adbSentChars = 0;
adbActionState = ADB_ACTION_OUT;
delay(ADB_DELAY);
adb_process_serial_intrs();
if (ADB_INTR_IS_ON) {
ADB_SET_STATE_IDLE_IISI();
ADB_SET_SR_INPUT();
adbSentChars = 0;
adbActionState = ADB_ACTION_IDLE;
adbInputBuffer[0] = 0;
delay(ADB_DELAY);
break;
}
ADB_SET_STATE_ACTIVE();
ADB_SET_STATE_ACKOFF();
ADB_SET_SR_OUTPUT();
ADB_SR() = adbOutputBuffer[adbSentChars + 1];
ADB_SET_STATE_ACKON();
}
}
break;
case ADB_ACTION_OUT:
(void)ADB_SR();
ADB_SET_SR_OUTPUT();
ADB_SET_STATE_ACKOFF();
adbSentChars++;
if (ADB_INTR_IS_ON) {
ADB_SET_STATE_IDLE_IISI();
ADB_SET_SR_INPUT();
adbSentChars = 0;
adbActionState = ADB_ACTION_IDLE;
adbInputBuffer[0] = 0;
adbWriteDelay = 1;
delay(ADB_DELAY);
adb_process_serial_intrs();
goto switch_start;
break;
}
delay(ADB_DELAY);
adb_process_serial_intrs();
if (adbOutputBuffer[0] == adbSentChars) {
if (0 == adb_cmd_result(adbOutputBuffer)) {
adbWaiting = 1;
adbWaitingCmd = adbOutputBuffer[2];
} else {
memcpy(packet.data, adbInputBuffer,
adbInputBuffer[0] + 1);
packet.saveBuf = adbBuffer;
packet.compRout = adbCompRout;
packet.compData = adbCompData;
packet.cmd = adbWaitingCmd;
packet.unsol = 0;
packet.ack_only = 1;
adb_pass_up(&packet);
adbWaitingCmd = 0;
adbBuffer = (long)0;
adbCompRout = (long)0;
adbCompData = (long)0;
}
adbWriteDelay = 0;
adbActionState = ADB_ACTION_IDLE;
ADB_SET_SR_INPUT();
ADB_SET_STATE_INACTIVE();
} else {
ADB_SR() = adbOutputBuffer[adbSentChars + 1];
ADB_SET_STATE_ACKON();
}
break;
case ADB_ACTION_NOTREADY:
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("adb: not yet initialized\n");
#endif
break;
default:
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("intr: unknown ADB state\n");
#endif
break;
}
ADB_VIA_INTR_ENABLE();
splx(s);
return;
}
int
send_adb_IIsi(u_char *in, u_char *buffer, void *compRout, void *data, int
command)
{
int s, len;
if (adbActionState == ADB_ACTION_NOTREADY)
return 1;
s = splhigh();
if ((adbActionState == ADB_ACTION_IDLE) &&
(ADB_INTR_IS_OFF)) {
} else
if (adbWriteDelay == 0)
adbWriteDelay = 1;
else {
splx(s);
return 1;
}
if ((long)in == (long)0) {
if ((command & 0x0c) == 0x08)
len = buffer[0];
else
len = 0;
adbOutputBuffer[0] = 2 + len;
adbOutputBuffer[1] = 0x00;
adbOutputBuffer[2] = (u_char)command;
memcpy(adbOutputBuffer + 3, buffer + 1, len);
} else
memcpy(adbOutputBuffer, in, in[0] + 2);
adbSentChars = 0;
adbBuffer = buffer;
adbCompRout = compRout;
adbCompData = data;
adbWaitingCmd = adbOutputBuffer[2];
if (adbWriteDelay != 1) {
adbActionState = ADB_ACTION_OUT;
ADB_SET_STATE_ACTIVE();
ADB_SET_STATE_ACKOFF();
ADB_SET_SR_OUTPUT();
ADB_SR() = adbOutputBuffer[adbSentChars + 1];
ADB_SET_STATE_ACKON();
}
adbWriteDelay = 1;
splx(s);
if (0x0100 <= (s & 0x0700))
while ((adbActionState != ADB_ACTION_IDLE) || (ADB_INTR_IS_ON)
|| (adbWaiting == 1))
if (ADB_SR_INTR_IS_ON) {
adb_intr_IIsi(NULL);
if (adb_polling)
adb_soft_intr();
}
return 0;
}
void
adb_iop_recv(IOP *iop, struct iop_msg *msg)
{
struct adbCommand pkt;
unsigned flags;
if (adbActionState != ADB_ACTION_RUNNING)
return;
switch (msg->status) {
case IOP_MSGSTAT_SENT:
if (0 == adb_cmd_result(msg->msg + 1)) {
adbWaiting = 1;
adbWaitingCmd = msg->msg[2];
}
break;
case IOP_MSGSTAT_RECEIVED:
case IOP_MSGSTAT_UNEXPECTED:
flags = msg->msg[0];
if (flags != 0) {
printf("ADB FLAGS 0x%x", flags);
break;
}
if (adbWaiting &&
(msg->msg[2] == adbWaitingCmd)) {
pkt.saveBuf = msg->msg + 1;
pkt.compRout = adbCompRout;
pkt.compData = adbCompData;
pkt.unsol = 0;
pkt.ack_only = 0;
adb_pass_up(&pkt);
adbWaitingCmd = 0;
adbWaiting = 0;
} else {
pkt.unsol = 1;
pkt.ack_only = 0;
adb_pass_up(&pkt);
}
break;
default:
return;
}
}
int
send_adb_iop(int cmd, u_char * buffer, void *compRout, void *data)
{
u_char buff[32];
int cnt;
if (adbActionState != ADB_ACTION_RUNNING)
return -1;
buff[0] = IOP_ADB_FL_EXPLICIT;
buff[1] = buffer[0];
buff[2] = cmd;
cnt = (int) buff[1];
memcpy(buff + 3, buffer + 1, cnt);
return iop_send_msg(ISM_IOP, IOP_CHAN_ADB, buff, cnt+3,
adb_iop_recv, NULL);
}
void
adb_pass_up(struct adbCommand *in)
{
int start = 0, len = 0, cmd = 0;
ADBDataBlock block;
if (adbInCount >= ADB_QUEUE) {
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("adb: ring buffer overflow\n");
#endif
return;
}
if (in->ack_only) {
len = in->data[0];
cmd = in->cmd;
start = 0;
} else {
switch (adbHardware) {
case ADB_HW_IOP:
case ADB_HW_II:
cmd = in->data[1];
if (in->data[0] < 2)
len = 0;
else
len = in->data[0]-1;
start = 1;
break;
case ADB_HW_IISI:
case ADB_HW_CUDA:
if (in->unsol)
if (0 != in->data[2])
return;
cmd = in->data[4];
if (in->data[0] < 5)
len = 0;
else
len = in->data[0]-4;
start = 4;
break;
case ADB_HW_PB:
cmd = in->data[1];
if (in->data[0] < 2)
len = 0;
else
len = in->data[0]-1;
start = 1;
break;
case ADB_HW_UNKNOWN:
return;
}
if (in->unsol) {
if (adbStarting)
return;
if (-1 == get_adb_info(&block, ADB_CMDADDR(cmd)))
return;
}
}
if (in->unsol) {
if (in->ack_only) panic("invalid ack-only pkg");
adbInbound[adbInTail].compRout = (void *)block.dbServiceRtPtr;
adbInbound[adbInTail].compData = (void *)block.dbDataAreaAddr;
adbInbound[adbInTail].saveBuf = (void *)adbInbound[adbInTail].data;
} else {
adbInbound[adbInTail].compRout = (void *)in->compRout;
adbInbound[adbInTail].compData = (void *)in->compData;
adbInbound[adbInTail].saveBuf = (void *)in->saveBuf;
}
#ifdef ADB_DEBUG
if (adb_debug && in->data[1] == 2)
printf_intr("adb: caught error\n");
#endif
memcpy(adbInbound[adbInTail].data + 1, in->data + start + 1, len);
adbInbound[adbInTail].data[0] = len;
adbInbound[adbInTail].cmd = cmd;
adbInCount++;
if (++adbInTail >= ADB_QUEUE)
adbInTail = 0;
if (adb_polling)
adb_soft_intr();
else
softint_schedule(adb_softintr_cookie);
return;
}
void
adb_soft_intr(void)
{
int s;
int cmd = 0;
u_char *buffer = 0;
u_char *comprout = 0;
u_char *compdata = 0;
#if 0
s = splhigh();
printf_intr("sr: %x\n", (s & 0x0700));
splx(s);
#endif
while (adbInCount) {
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("%x %x %x ",
adbInCount, adbInHead, adbInTail);
#endif
buffer = adbInbound[adbInHead].saveBuf;
comprout = adbInbound[adbInHead].compRout;
compdata = adbInbound[adbInHead].compData;
cmd = adbInbound[adbInHead].cmd;
if (buffer)
memcpy(buffer, adbInbound[adbInHead].data,
adbInbound[adbInHead].data[0] + 1);
#ifdef ADB_DEBUG
if (adb_debug & 0x80) {
printf_intr("%p %p %p %x ",
buffer, comprout, compdata, (short)cmd);
printf_intr("buf: ");
print_single(adbInbound[adbInHead].data);
}
#endif
if (comprout) {
#ifdef __NetBSD__
__asm volatile (
" movml #0xffff,%%sp@- \n"
" movl %0,%%a2 \n"
" movl %1,%%a1 \n"
" movl %2,%%a0 \n"
" movl %3,%%d0 \n"
" jbsr %%a1@ \n"
" movml %%sp@+,#0xffff"
:
: "g"(compdata), "g"(comprout),
"g"(buffer), "g"(cmd)
: "d0", "a0", "a1", "a2");
#else
asm
{
movem.l a0/a1/a2/d0, -(a7)
move.l compdata, a2
move.l comprout, a1
move.l buffer, a0
move.w cmd, d0
jsr(a1)
movem.l(a7)+, d0/a2/a1/a0
}
#endif
}
s = splhigh();
adbInCount--;
if (++adbInHead >= ADB_QUEUE)
adbInHead = 0;
splx(s);
}
return;
}
int
adb_op(Ptr buffer, Ptr compRout, Ptr data, short command)
{
int result;
switch (adbHardware) {
case ADB_HW_II:
result = send_adb_II((u_char *)0, (u_char *)buffer,
(void *)compRout, (void *)data, (int)command);
if (result == 0)
return 0;
else
return -1;
break;
case ADB_HW_IOP:
#ifdef __notyet__
result = send_adb_iop((int)command, (u_char *)buffer,
(void *)compRout, (void *)data);
if (result == 0)
return 0;
else
#endif
return -1;
break;
case ADB_HW_IISI:
result = send_adb_IIsi((u_char *)0, (u_char *)buffer,
(void *)compRout, (void *)data, (int)command);
delay(100);
if (result == 0)
return 0;
else
return -1;
break;
case ADB_HW_PB:
result = pm_adb_op((u_char *)buffer, (void *)compRout,
(void *)data, (int)command);
if (result == 0)
return 0;
else
return -1;
break;
case ADB_HW_CUDA:
result = send_adb_cuda((u_char *)0, (u_char *)buffer,
(void *)compRout, (void *)data, (int)command);
if (result == 0)
return 0;
else
return -1;
break;
case ADB_HW_UNKNOWN:
default:
return -1;
}
}
void
adb_hw_setup(void)
{
volatile int i;
u_char send_string[ADB_MAX_MSG_LENGTH];
switch (adbHardware) {
case ADB_HW_II:
via1_register_irq(2, adb_intr_II, NULL);
via_reg(VIA1, vDirB) |= 0x30;
via_reg(VIA1, vDirB) &= 0xf7;
via_reg(VIA1, vACR) &= ~vSR_OUT;
adbActionState = ADB_ACTION_IDLE;
adbBusState = ADB_BUS_IDLE;
via_reg(VIA1, vIER) = 0x84;
ADB_SET_STATE_IDLE_II();
ADB_VIA_CLR_INTR();
break;
case ADB_HW_IOP:
via_reg(VIA1, vIER) = 0x84;
via_reg(VIA1, vIFR) = 0x04;
#ifdef __notyet__
adbActionState = ADB_ACTION_RUNNING;
#endif
break;
case ADB_HW_IISI:
via1_register_irq(2, adb_intr_IIsi, NULL);
via_reg(VIA1, vDirB) |= 0x30;
via_reg(VIA1, vDirB) &= 0xf7;
via_reg(VIA1, vACR) &= ~vSR_OUT;
adbActionState = ADB_ACTION_IDLE;
adbBusState = ADB_BUS_IDLE;
via_reg(VIA1, vIER) = 0x84;
ADB_SET_STATE_IDLE_IISI();
for (i = 0; i < 30; i++) {
delay(ADB_DELAY);
adb_hw_setup_IIsi(send_string);
#ifdef ADB_DEBUG
if (adb_debug) {
printf_intr("adb: cleanup: ");
print_single(send_string);
}
#endif
delay(ADB_DELAY);
if (ADB_INTR_IS_OFF)
break;
}
break;
case ADB_HW_PB:
pm_hw_setup();
break;
case ADB_HW_CUDA:
via1_register_irq(2, adb_intr_cuda, NULL);
via_reg(VIA1, vDirB) |= 0x30;
via_reg(VIA1, vDirB) &= 0xf7;
via_reg(VIA1, vACR) &= ~vSR_OUT;
via_reg(VIA1, vACR) = (via_reg(VIA1, vACR) | 0x0c) & ~0x10;
adbActionState = ADB_ACTION_IDLE;
adbBusState = ADB_BUS_IDLE;
via_reg(VIA1, vIER) = 0x84;
ADB_SET_STATE_IDLE_CUDA();
i = ADB_SR();
ADB_VIA_INTR_DISABLE();
ADB_SET_STATE_IDLE_CUDA();
delay(ADB_DELAY);
ADB_SET_STATE_TIP();
delay(ADB_DELAY);
ADB_TOGGLE_STATE_ACK_CUDA();
delay(ADB_DELAY);
ADB_CLR_STATE_TIP();
delay(ADB_DELAY);
ADB_SET_STATE_IDLE_CUDA();
i = ADB_SR();
ADB_VIA_INTR_ENABLE();
break;
case ADB_HW_UNKNOWN:
default:
via_reg(VIA1, vIER) = 0x04;
return;
break;
}
}
void
adb_hw_setup_IIsi(u_char *buffer)
{
int i;
int s;
long my_time;
int endofframe;
delay(ADB_DELAY);
i = 1;
s = splhigh();
ADB_SET_SR_INPUT();
ADB_VIA_INTR_DISABLE();
delay(ADB_DELAY);
if (ADB_INTR_IS_ON) {
ADB_SET_STATE_ACTIVE();
endofframe = 0;
while (0 == endofframe) {
my_time = ADB_DELAY * 5;
while ((ADB_SR_INTR_IS_OFF) && (my_time-- > 0))
(void)via_reg(VIA1, vBufB);
buffer[i++] = ADB_SR();
if (ADB_INTR_IS_OFF)
endofframe = 1;
ADB_SET_STATE_ACKON();
delay(ADB_DELAY);
ADB_SET_STATE_ACKOFF();
}
ADB_SET_STATE_INACTIVE();
delay(ADB_DELAY);
}
buffer[0] = --i;
ADB_VIA_INTR_ENABLE();
splx(s);
return;
}
void
adb_reinit(void)
{
u_char send_string[ADB_MAX_MSG_LENGTH];
ADBDataBlock data;
volatile int i, x;
int s;
int command;
int result;
int saveptr;
int device;
int nonewtimes;
static bool again;
if (!again) {
callout_init(&adb_cuda_tickle_ch, 0);
again = true;
}
adb_setup_hw_type();
if (adbHardware != ADB_HW_PB && adbHardware != ADB_HW_IOP)
s = splhigh();
else
s = 0;
ADBNumDevices = 0;
adbStarting = 1;
for (i = 0; i < 16; i++) {
ADBDevTable[i].devType = 0;
ADBDevTable[i].origAddr = ADBDevTable[i].currentAddr = 0;
}
adb_hw_setup();
delay(1000);
(void)adb_op_sync((Ptr)0, (Ptr)0, (Ptr)0, (short)0x00);
delay(3000);
for (i = 1; i < 16; i++) {
command = ADBTALK(i, 3);
result = adb_op_sync((Ptr)send_string, (Ptr)0,
(Ptr)0, (short)command);
if (result == 0 && send_string[0] != 0) {
++ADBNumDevices;
KASSERT(ADBNumDevices < 16);
ADBDevTable[ADBNumDevices].devType =
(int)(send_string[2]);
ADBDevTable[ADBNumDevices].origAddr = i;
ADBDevTable[ADBNumDevices].currentAddr = i;
ADBDevTable[ADBNumDevices].DataAreaAddr =
(long)0;
ADBDevTable[ADBNumDevices].ServiceRtPtr = (void *)0;
pm_check_adb_devices(i);
}
}
for (saveptr = 15; saveptr > 0; saveptr--)
if (-1 == get_adb_info(&data, saveptr))
break;
#ifdef ADB_DEBUG
if (adb_debug & 0x80) {
printf_intr("first free is: 0x%02x\n", saveptr);
printf_intr("devices: %i\n", ADBNumDevices);
}
#endif
nonewtimes = 0;
while (saveptr > 0 && nonewtimes++ < 11) {
for (i = 1;saveptr > 0 && i <= ADBNumDevices; i++) {
device = ADBDevTable[i].currentAddr;
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("moving device 0x%02x to 0x%02x "
"(index 0x%02x) ", device, saveptr, i);
#endif
command = ADBTALK(device, 3);
(void)adb_op_sync((Ptr)send_string, (Ptr)0,
(Ptr)0, (short)command);
command = ADBLISTEN(device, 3);
send_string[0] = 2;
send_string[1] = (u_char)(saveptr | 0x60);
send_string[2] = 0xfe;
(void)adb_op_sync((Ptr)send_string, (Ptr)0,
(Ptr)0, (short)command);
delay(1000);
command = ADBTALK(saveptr, 3);
send_string[0] = 0;
result = adb_op_sync((Ptr)send_string, (Ptr)0,
(Ptr)0, (short)command);
delay(1000);
if (result != 0 || send_string[0] == 0) {
command = ADBLISTEN(saveptr, 3);
send_string[0] = 2;
send_string[1] = (u_char)(device | 0x60);
send_string[2] = 0x00;
(void)adb_op_sync((Ptr)send_string, (Ptr)0,
(Ptr)0, (short)command);
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("failed, continuing\n");
#endif
delay(1000);
continue;
}
command = ADBTALK(device, 3);
send_string[0] = 0;
result = adb_op_sync((Ptr)send_string, (Ptr)0,
(Ptr)0, (short)command);
if (result == 0 && send_string[0] != 0) {
ADBDevTable[i].currentAddr = saveptr;
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("old device at index %i\n",i);
#endif
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("new device found\n");
#endif
if (saveptr > ADBNumDevices) {
++ADBNumDevices;
KASSERT(ADBNumDevices < 16);
}
ADBDevTable[ADBNumDevices].devType =
(int)(send_string[2]);
ADBDevTable[ADBNumDevices].origAddr = device;
ADBDevTable[ADBNumDevices].currentAddr = device;
ADBDevTable[ADBNumDevices].DataAreaAddr =
(long)0;
ADBDevTable[ADBNumDevices].ServiceRtPtr =
(void *)0;
for (x = saveptr; x > 0; x--) {
if (-1 == get_adb_info(&data, x)) {
saveptr = x;
break;
}
}
if (x == 0)
saveptr = 0;
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("new free is 0x%02x\n",
saveptr);
#endif
nonewtimes = 0;
pm_check_adb_devices(device);
} else {
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("moving back...\n");
#endif
command = ADBLISTEN(saveptr, 3);
send_string[0] = 2;
send_string[1] = (u_char)(device | 0x60);
send_string[2] = 0xfe;
(void)adb_op_sync((Ptr)send_string, (Ptr)0,
(Ptr)0, (short)command);
delay(1000);
}
}
}
#ifdef ADB_DEBUG
if (adb_debug) {
for (i = 1; i <= ADBNumDevices; i++) {
x = get_ind_adb_info(&data, i);
if (x != -1)
printf_intr("index 0x%x, addr 0x%x, type 0x%hx\n",
i, x, data.devType);
}
}
#endif
#ifndef MRG_ADB
adb_prog_switch_enable();
#endif
#ifdef ADB_DEBUG
if (adb_debug) {
if (0 == ADBNumDevices)
printf_intr("adb: no devices found\n");
}
#endif
adbStarting = 0;
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("adb: ADBReInit complete\n");
#endif
if (adbHardware == ADB_HW_CUDA)
callout_reset(&adb_cuda_tickle_ch, ADB_TICKLE_TICKS,
(void *)adb_cuda_tickle, NULL);
if (adbHardware != ADB_HW_PB && adbHardware != ADB_HW_IOP)
splx(s);
return;
}
void
adb_comp_exec(void)
{
if ((long)0 != adbCompRout)
#ifdef __NetBSD__
__asm volatile(
" movml #0xffff,%%sp@- \n"
" movl %0,%%a2 \n"
" movl %1,%%a1 \n"
" movl %2,%%a0 \n"
" movl %3,%%d0 \n"
" jbsr %%a1@ \n"
" movml %%sp@+,#0xffff"
:
: "g"(adbCompData), "g"(adbCompRout),
"g"(adbBuffer), "g"(adbWaitingCmd)
: "d0", "a0", "a1", "a2");
#else
asm {
movem.l a0/a1/a2/d0, -(a7)
move.l adbCompData, a2
move.l adbCompRout, a1
move.l adbBuffer, a0
move.w adbWaitingCmd, d0
jsr(a1)
movem.l(a7) +, d0/a2/a1/a0
}
#endif
}
int
adb_cmd_result(u_char *in)
{
switch (adbHardware) {
case ADB_HW_IOP:
case ADB_HW_II:
if ((in[1] & 0x0c) == 0x0c)
return 0;
return 1;
case ADB_HW_IISI:
case ADB_HW_CUDA:
if ((in[1] == 0x00) && ((in[2] & 0x0c) == 0x0c))
return 0;
if ((in[1] == 0x01) && (in[2] == 0x03))
return 0;
return 1;
case ADB_HW_PB:
return 1;
case ADB_HW_UNKNOWN:
default:
return 1;
}
}
int
adb_cmd_extra(u_char *in)
{
switch (adbHardware) {
case ADB_HW_II:
case ADB_HW_IOP:
if ((in[1] & 0x0c) == 0x08)
return 0;
return 1;
case ADB_HW_IISI:
case ADB_HW_CUDA:
if ((in[2] & 0x0c) == 0x08)
return 0;
return 1;
case ADB_HW_PB:
return 1;
case ADB_HW_UNKNOWN:
default:
return 1;
}
}
void
adb_setup_hw_type(void)
{
long response;
response = mac68k_machine.machineid;
switch (response) {
case MACH_MACC610:
case MACH_MACC650:
case MACH_MACII:
case MACH_MACIICI:
case MACH_MACIICX:
case MACH_MACIIX:
case MACH_MACQ610:
case MACH_MACQ650:
case MACH_MACQ700:
case MACH_MACQ800:
case MACH_MACSE30:
adbHardware = ADB_HW_II;
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("adb: using II series hardware support\n");
#endif
break;
case MACH_MACCLASSICII:
case MACH_MACLCII:
case MACH_MACLCIII:
case MACH_MACIISI:
case MACH_MACIIVI:
case MACH_MACIIVX:
case MACH_MACP460:
case MACH_MACP600:
adbHardware = ADB_HW_IISI;
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("adb: using IIsi series hardware support\n");
#endif
break;
case MACH_MACPB140:
case MACH_MACPB145:
case MACH_MACPB160:
case MACH_MACPB165:
case MACH_MACPB165C:
case MACH_MACPB170:
case MACH_MACPB180:
case MACH_MACPB180C:
adbHardware = ADB_HW_PB;
pm_setup_adb();
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("adb: using PowerBook 100-series hardware support\n");
#endif
break;
case MACH_MACPB150:
case MACH_MACPB210:
case MACH_MACPB230:
case MACH_MACPB250:
case MACH_MACPB270:
case MACH_MACPB280:
case MACH_MACPB280C:
case MACH_MACPB500:
case MACH_MACPB190:
case MACH_MACPB190CS:
adbHardware = ADB_HW_PB;
pm_setup_adb();
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("adb: using PowerBook Duo-series and PowerBook 500-series hardware support\n");
#endif
break;
case MACH_MACC660AV:
case MACH_MACCCLASSIC:
case MACH_MACCCLASSICII:
case MACH_MACLC475:
case MACH_MACLC475_33:
case MACH_MACLC520:
case MACH_MACLC575:
case MACH_MACP550:
case MACH_MACTV:
case MACH_MACP580:
case MACH_MACQ605:
case MACH_MACQ605_33:
case MACH_MACQ630:
case MACH_MACQ840AV:
adbHardware = ADB_HW_CUDA;
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("adb: using Cuda series hardware support\n");
#endif
break;
case MACH_MACQ900:
case MACH_MACQ950:
case MACH_MACIIFX:
adbHardware = ADB_HW_IOP;
iop_register_listener(ISM_IOP, IOP_CHAN_ADB, adb_iop_recv, NULL);
#ifdef ADB_DEBUG
if (adb_debug)
printf_intr("adb: using IOP-based ADB\n");
#endif
break;
default:
adbHardware = ADB_HW_UNKNOWN;
#ifdef ADB_DEBUG
if (adb_debug) {
printf_intr("adb: hardware type unknown for this machine\n");
printf_intr("adb: ADB support is disabled\n");
}
#endif
break;
}
switch (response) {
case MACH_MACCCLASSIC:
case MACH_MACCCLASSICII:
case MACH_MACIISI:
case MACH_MACIIVI:
case MACH_MACIIVX:
case MACH_MACLC520:
case MACH_MACLC575:
case MACH_MACP550:
case MACH_MACTV:
case MACH_MACP580:
case MACH_MACP600:
case MACH_MACQ630:
case MACH_MACQ840AV:
adbSoftPower = 1;
break;
}
}
int
count_adbs(void)
{
int i;
int found;
found = 0;
for (i = 1; i < 16; i++)
if (0 != ADBDevTable[i].currentAddr)
found++;
return found;
}
int
get_ind_adb_info(ADBDataBlock *info, int index)
{
if ((index < 1) || (index > 15))
return (-1);
#ifdef ADB_DEBUG
if (adb_debug & 0x80)
printf_intr("index 0x%x devType is: 0x%x\n", index,
ADBDevTable[index].devType);
#endif
if (0 == ADBDevTable[index].devType)
return (-1);
info->devType = (unsigned char)(ADBDevTable[index].devType);
info->origADBAddr = (unsigned char)(ADBDevTable[index].origAddr);
info->dbServiceRtPtr = (Ptr)ADBDevTable[index].ServiceRtPtr;
info->dbDataAreaAddr = (Ptr)ADBDevTable[index].DataAreaAddr;
return (ADBDevTable[index].currentAddr);
}
int
get_adb_info(ADBDataBlock *info, int adbAddr)
{
int i;
if ((adbAddr < 1) || (adbAddr > 15))
return (-1);
for (i = 1; i < 15; i++)
if (ADBDevTable[i].currentAddr == adbAddr) {
info->devType = (unsigned char)(ADBDevTable[i].devType);
info->origADBAddr = (unsigned char)(ADBDevTable[i].origAddr);
info->dbServiceRtPtr = (Ptr)ADBDevTable[i].ServiceRtPtr;
info->dbDataAreaAddr = ADBDevTable[i].DataAreaAddr;
return 0;
}
return (-1);
}
int
set_adb_info(ADBSetInfoBlock *info, int adbAddr)
{
int i;
if ((adbAddr < 1) || (adbAddr > 15))
return (-1);
for (i = 1; i < 15; i++)
if (ADBDevTable[i].currentAddr == adbAddr) {
ADBDevTable[i].ServiceRtPtr =
(void *)(info->siServiceRtPtr);
ADBDevTable[i].DataAreaAddr = info->siDataAreaAddr;
return 0;
}
return (-1);
}
#ifndef MRG_ADB
long
mrg_adbintr(void)
{
adb_intr(NULL);
return 1;
}
long
mrg_pmintr(void)
{
pm_intr(NULL);
return 1;
}
int
adb_read_date_time(unsigned long *curtime)
{
u_char output[ADB_MAX_MSG_LENGTH];
int result;
volatile int flag = 0;
switch (adbHardware) {
case ADB_HW_II:
return -1;
case ADB_HW_IOP:
return -1;
case ADB_HW_IISI:
output[0] = 0x02;
output[1] = 0x01;
output[2] = 0x03;
result = send_adb_IIsi((u_char *)output, (u_char *)output,
(void *)adb_op_comprout, __UNVOLATILE(&flag), (int)0);
if (result != 0)
return -1;
adb_spin(&flag);
if (flag == 0)
return -1;
*curtime = (long)(*(long *)(output + 1));
return 0;
case ADB_HW_PB:
return -1;
case ADB_HW_CUDA:
output[0] = 0x02;
output[1] = 0x01;
output[2] = 0x03;
result = send_adb_cuda((u_char *)output, (u_char *)output,
(void *)adb_op_comprout, __UNVOLATILE(&flag), (int)0);
if (result != 0)
return -1;
adb_spin(&flag);
if (flag == 0)
return -1;
*curtime = (long)(*(long *)(output + 1));
return 0;
case ADB_HW_UNKNOWN:
default:
return -1;
}
}
int
adb_set_date_time(unsigned long curtime)
{
u_char output[ADB_MAX_MSG_LENGTH];
int result;
volatile int flag = 0;
switch (adbHardware) {
case ADB_HW_II:
return -1;
case ADB_HW_IOP:
return -1;
case ADB_HW_IISI:
output[0] = 0x06;
output[1] = 0x01;
output[2] = 0x09;
output[3] = (u_char)(curtime >> 24);
output[4] = (u_char)(curtime >> 16);
output[5] = (u_char)(curtime >> 8);
output[6] = (u_char)(curtime);
result = send_adb_IIsi((u_char *)output, (u_char *)0,
(void *)adb_op_comprout, __UNVOLATILE(&flag), (int)0);
if (result != 0)
return -1;
adb_spin(&flag);
if (flag == 0)
return -1;
return 0;
case ADB_HW_PB:
return -1;
case ADB_HW_CUDA:
output[0] = 0x06;
output[1] = 0x01;
output[2] = 0x09;
output[3] = (u_char)(curtime >> 24);
output[4] = (u_char)(curtime >> 16);
output[5] = (u_char)(curtime >> 8);
output[6] = (u_char)(curtime);
result = send_adb_cuda((u_char *)output, (u_char *)0,
(void *)adb_op_comprout, __UNVOLATILE(&flag), (int)0);
if (result != 0)
return -1;
adb_spin(&flag);
if (flag == 0)
return -1;
return 0;
case ADB_HW_UNKNOWN:
default:
return -1;
}
}
int
adb_poweroff(void)
{
u_char output[ADB_MAX_MSG_LENGTH];
int result;
if (!adbSoftPower)
return -1;
adb_polling = 1;
switch (adbHardware) {
case ADB_HW_IISI:
output[0] = 0x02;
output[1] = 0x01;
output[2] = 0x0a;
result = send_adb_IIsi((u_char *)output, (u_char *)0,
(void *)0, (void *)0, (int)0);
if (result != 0)
return -1;
for (;;);
return 0;
case ADB_HW_PB:
return -1;
case ADB_HW_CUDA:
output[0] = 0x02;
output[1] = 0x01;
output[2] = 0x0a;
result = send_adb_cuda((u_char *)output, (u_char *)0,
(void *)0, (void *)0, (int)0);
if (result != 0)
return -1;
for (;;);
return 0;
case ADB_HW_II:
case ADB_HW_IOP:
case ADB_HW_UNKNOWN:
default:
return -1;
}
}
int
adb_prog_switch_enable(void)
{
u_char output[ADB_MAX_MSG_LENGTH];
int result;
volatile int flag = 0;
switch (adbHardware) {
case ADB_HW_IISI:
output[0] = 0x03;
output[1] = 0x01;
output[2] = 0x1c;
output[3] = 0x01;
result = send_adb_IIsi((u_char *)output, (u_char *)0,
(void *)adb_op_comprout, __UNVOLATILE(&flag), (int)0);
if (result != 0)
return -1;
adb_spin(&flag);
if (flag == 0)
return -1;
return 0;
case ADB_HW_PB:
return -1;
case ADB_HW_II:
case ADB_HW_IOP:
case ADB_HW_CUDA:
case ADB_HW_UNKNOWN:
default:
return -1;
}
}
int
adb_prog_switch_disable(void)
{
u_char output[ADB_MAX_MSG_LENGTH];
int result;
volatile int flag = 0;
switch (adbHardware) {
case ADB_HW_IISI:
output[0] = 0x03;
output[1] = 0x01;
output[2] = 0x1c;
output[3] = 0x01;
result = send_adb_IIsi((u_char *)output, (u_char *)0,
(void *)adb_op_comprout, __UNVOLATILE(&flag), (int)0);
if (result != 0)
return -1;
adb_spin(&flag);
if (flag == 0)
return -1;
return 0;
case ADB_HW_PB:
return -1;
case ADB_HW_II:
case ADB_HW_IOP:
case ADB_HW_CUDA:
case ADB_HW_UNKNOWN:
default:
return -1;
}
}
int
CountADBs(void)
{
return (count_adbs());
}
void
ADBReInit(void)
{
adb_reinit();
}
int
GetIndADB(ADBDataBlock *info, int index)
{
return (get_ind_adb_info(info, index));
}
int
GetADBInfo(ADBDataBlock *info, int adbAddr)
{
return (get_adb_info(info, adbAddr));
}
int
SetADBInfo(ADBSetInfoBlock *info, int adbAddr)
{
return (set_adb_info(info, adbAddr));
}
int
ADBOp(Ptr buffer, Ptr compRout, Ptr data, short commandNum)
{
return (adb_op(buffer, compRout, data, commandNum));
}
#endif