2156 lines
56 KiB
C
2156 lines
56 KiB
C
/* $NetBSD: adb_direct.c,v 1.24 2002/05/05 18:36:03 tsutsui Exp $ */
|
|
|
|
/* From: adb_direct.c 2.02 4/18/97 jpw */
|
|
|
|
/*
|
|
* Copyright (C) 1996, 1997 John P. Wittkoski
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by John P. Wittkoski.
|
|
* 4. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
|
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
/*
|
|
* This code is rather messy, but I don't have time right now
|
|
* to clean it up as much as I would like.
|
|
* But it works, so I'm happy. :-) jpw
|
|
*/
|
|
|
|
/*
|
|
* TO DO:
|
|
* - We could reduce the time spent in the adb_intr_* routines
|
|
* by having them save the incoming and outgoing data directly
|
|
* in the adbInbound and adbOutbound queues, as it would reduce
|
|
* the number of times we need to copy the data around. It
|
|
* would also make the code more readable and easier to follow.
|
|
* - (Related to above) Use the header part of adbCommand to
|
|
* reduce the number of copies we have to do of the data.
|
|
* - (Related to above) Actually implement the adbOutbound queue.
|
|
* This is fairly easy once you switch all the intr routines
|
|
* over to using adbCommand structs directly.
|
|
* - There is a bug in the state machine of adb_intr_cuda
|
|
* code that causes hangs, especially on 030 machines, probably
|
|
* because of some timing issues. Because I have been unable to
|
|
* determine the exact cause of this bug, I used the timeout function
|
|
* to check for and recover from this condition. If anyone finds
|
|
* the actual cause of this bug, the calls to timeout and the
|
|
* adb_cuda_tickle routine can be removed.
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/cdefs.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/callout.h>
|
|
#include <sys/device.h>
|
|
|
|
#include <machine/param.h>
|
|
#include <machine/cpu.h>
|
|
#include <machine/adbsys.h>
|
|
|
|
#include <macppc/dev/viareg.h>
|
|
#include <macppc/dev/adbvar.h>
|
|
#include <macppc/dev/pm_direct.h>
|
|
|
|
#define printf_intr printf
|
|
|
|
#ifdef DEBUG
|
|
#ifndef ADB_DEBUG
|
|
#define ADB_DEBUG
|
|
#endif
|
|
#endif
|
|
|
|
/* some misc. leftovers */
|
|
#define vPB 0x0000
|
|
#define vPB3 0x08
|
|
#define vPB4 0x10
|
|
#define vPB5 0x20
|
|
#define vSR_INT 0x04
|
|
#define vSR_OUT 0x10
|
|
|
|
/* the type of ADB action that we are currently preforming */
|
|
#define ADB_ACTION_NOTREADY 0x1 /* has not been initialized yet */
|
|
#define ADB_ACTION_IDLE 0x2 /* the bus is currently idle */
|
|
#define ADB_ACTION_OUT 0x3 /* sending out a command */
|
|
#define ADB_ACTION_IN 0x4 /* receiving data */
|
|
#define ADB_ACTION_POLLING 0x5 /* polling - II only */
|
|
|
|
/*
|
|
* These describe the state of the ADB bus itself, although they
|
|
* don't necessarily correspond directly to ADB states.
|
|
* Note: these are not really used in the IIsi code.
|
|
*/
|
|
#define ADB_BUS_UNKNOWN 0x1 /* we don't know yet - all models */
|
|
#define ADB_BUS_IDLE 0x2 /* bus is idle - all models */
|
|
#define ADB_BUS_CMD 0x3 /* starting a command - II models */
|
|
#define ADB_BUS_ODD 0x4 /* the "odd" state - II models */
|
|
#define ADB_BUS_EVEN 0x5 /* the "even" state - II models */
|
|
#define ADB_BUS_ACTIVE 0x6 /* active state - IIsi models */
|
|
#define ADB_BUS_ACK 0x7 /* currently ACKing - IIsi models */
|
|
|
|
/*
|
|
* Shortcuts for setting or testing the VIA bit states.
|
|
* Not all shortcuts are used for every type of ADB hardware.
|
|
*/
|
|
#define ADB_SET_STATE_IDLE_II() via_reg_or(VIA1, vBufB, (vPB4 | vPB5))
|
|
#define ADB_SET_STATE_IDLE_IISI() via_reg_and(VIA1, vBufB, ~(vPB4 | vPB5))
|
|
#define ADB_SET_STATE_IDLE_CUDA() via_reg_or(VIA1, vBufB, (vPB4 | vPB5))
|
|
#define ADB_SET_STATE_CMD() via_reg_and(VIA1, vBufB, ~(vPB4 | vPB5))
|
|
#define ADB_SET_STATE_EVEN() write_via_reg(VIA1, vBufB, \
|
|
(read_via_reg(VIA1, vBufB) | vPB4) & ~vPB5)
|
|
#define ADB_SET_STATE_ODD() write_via_reg(VIA1, vBufB, \
|
|
(read_via_reg(VIA1, vBufB) | vPB5) & ~vPB4 )
|
|
#define ADB_SET_STATE_ACTIVE() via_reg_or(VIA1, vBufB, vPB5)
|
|
#define ADB_SET_STATE_INACTIVE() via_reg_and(VIA1, vBufB, ~vPB5)
|
|
#define ADB_SET_STATE_TIP() via_reg_and(VIA1, vBufB, ~vPB5)
|
|
#define ADB_CLR_STATE_TIP() via_reg_or(VIA1, vBufB, vPB5)
|
|
#define ADB_SET_STATE_ACKON() via_reg_or(VIA1, vBufB, vPB4)
|
|
#define ADB_SET_STATE_ACKOFF() via_reg_and(VIA1, vBufB, ~vPB4)
|
|
#define ADB_TOGGLE_STATE_ACK_CUDA() via_reg_xor(VIA1, vBufB, vPB4)
|
|
#define ADB_SET_STATE_ACKON_CUDA() via_reg_and(VIA1, vBufB, ~vPB4)
|
|
#define ADB_SET_STATE_ACKOFF_CUDA() via_reg_or(VIA1, vBufB, vPB4)
|
|
#define ADB_SET_SR_INPUT() via_reg_and(VIA1, vACR, ~vSR_OUT)
|
|
#define ADB_SET_SR_OUTPUT() via_reg_or(VIA1, vACR, vSR_OUT)
|
|
#define ADB_SR() read_via_reg(VIA1, vSR)
|
|
#define ADB_VIA_INTR_ENABLE() write_via_reg(VIA1, vIER, 0x84)
|
|
#define ADB_VIA_INTR_DISABLE() write_via_reg(VIA1, vIER, 0x04)
|
|
#define ADB_VIA_CLR_INTR() write_via_reg(VIA1, vIFR, 0x04)
|
|
#define ADB_INTR_IS_OFF (vPB3 == (read_via_reg(VIA1, vBufB) & vPB3))
|
|
#define ADB_INTR_IS_ON (0 == (read_via_reg(VIA1, vBufB) & vPB3))
|
|
#define ADB_SR_INTR_IS_OFF (0 == (read_via_reg(VIA1, vIFR) & vSR_INT))
|
|
#define ADB_SR_INTR_IS_ON (vSR_INT == (read_via_reg(VIA1, \
|
|
vIFR) & vSR_INT))
|
|
|
|
/*
|
|
* This is the delay that is required (in uS) between certain
|
|
* ADB transactions. The actual timing delay for for each uS is
|
|
* calculated at boot time to account for differences in machine speed.
|
|
*/
|
|
#define ADB_DELAY 150
|
|
|
|
/*
|
|
* Maximum ADB message length; includes space for data, result, and
|
|
* device code - plus a little for safety.
|
|
*/
|
|
#define ADB_MAX_MSG_LENGTH 16
|
|
#define ADB_MAX_HDR_LENGTH 8
|
|
|
|
#define ADB_QUEUE 32
|
|
#define ADB_TICKLE_TICKS 4
|
|
|
|
/*
|
|
* A structure for storing information about each ADB device.
|
|
*/
|
|
struct ADBDevEntry {
|
|
void (*ServiceRtPtr) __P((void));
|
|
void *DataAreaAddr;
|
|
int devType;
|
|
int origAddr;
|
|
int currentAddr;
|
|
};
|
|
|
|
/*
|
|
* Used to hold ADB commands that are waiting to be sent out.
|
|
*/
|
|
struct adbCmdHoldEntry {
|
|
u_char outBuf[ADB_MAX_MSG_LENGTH]; /* our message */
|
|
u_char *saveBuf; /* buffer to know where to save result */
|
|
u_char *compRout; /* completion routine pointer */
|
|
u_char *data; /* completion routine data pointer */
|
|
};
|
|
|
|
/*
|
|
* Eventually used for two separate queues, the queue between
|
|
* the upper and lower halves, and the outgoing packet queue.
|
|
* TO DO: adbCommand can replace all of adbCmdHoldEntry eventually
|
|
*/
|
|
struct adbCommand {
|
|
u_char header[ADB_MAX_HDR_LENGTH]; /* not used yet */
|
|
u_char data[ADB_MAX_MSG_LENGTH]; /* packet data only */
|
|
u_char *saveBuf; /* where to save result */
|
|
u_char *compRout; /* completion routine pointer */
|
|
u_char *compData; /* completion routine data pointer */
|
|
u_int cmd; /* the original command for this data */
|
|
u_int unsol; /* 1 if packet was unsolicited */
|
|
u_int ack_only; /* 1 for no special processing */
|
|
};
|
|
|
|
/*
|
|
* A few variables that we need and their initial values.
|
|
*/
|
|
int adbHardware = ADB_HW_UNKNOWN;
|
|
int adbActionState = ADB_ACTION_NOTREADY;
|
|
int adbBusState = ADB_BUS_UNKNOWN;
|
|
int adbWaiting = 0; /* waiting for return data from the device */
|
|
int adbWriteDelay = 0; /* working on (or waiting to do) a write */
|
|
int adbOutQueueHasData = 0; /* something in the queue waiting to go out */
|
|
int adbNextEnd = 0; /* the next incoming bute is the last (II) */
|
|
int adbSoftPower = 0; /* machine supports soft power */
|
|
|
|
int adbWaitingCmd = 0; /* ADB command we are waiting for */
|
|
u_char *adbBuffer = (long)0; /* pointer to user data area */
|
|
void *adbCompRout = (long)0; /* pointer to the completion routine */
|
|
void *adbCompData = (long)0; /* pointer to the completion routine data */
|
|
long adbFakeInts = 0; /* keeps track of fake ADB interrupts for
|
|
* timeouts (II) */
|
|
int adbStarting = 1; /* doing ADBReInit so do polling differently */
|
|
int adbSendTalk = 0; /* the intr routine is sending the talk, not
|
|
* the user (II) */
|
|
int adbPolling = 0; /* we are polling for service request */
|
|
int adbPollCmd = 0; /* the last poll command we sent */
|
|
|
|
u_char adbInputBuffer[ADB_MAX_MSG_LENGTH]; /* data input buffer */
|
|
u_char adbOutputBuffer[ADB_MAX_MSG_LENGTH]; /* data output buffer */
|
|
struct adbCmdHoldEntry adbOutQueue; /* our 1 entry output queue */
|
|
|
|
int adbSentChars = 0; /* how many characters we have sent */
|
|
int adbLastDevice = 0; /* last ADB dev we heard from (II ONLY) */
|
|
int adbLastDevIndex = 0; /* last ADB dev loc in dev table (II ONLY) */
|
|
int adbLastCommand = 0; /* the last ADB command we sent (II) */
|
|
|
|
struct ADBDevEntry ADBDevTable[16]; /* our ADB device table */
|
|
int ADBNumDevices; /* num. of ADB devices found with ADBReInit */
|
|
|
|
struct adbCommand adbInbound[ADB_QUEUE]; /* incoming queue */
|
|
int adbInCount = 0; /* how many packets in in queue */
|
|
int adbInHead = 0; /* head of in queue */
|
|
int adbInTail = 0; /* tail of in queue */
|
|
struct adbCommand adbOutbound[ADB_QUEUE]; /* outgoing queue - not used yet */
|
|
int adbOutCount = 0; /* how many packets in out queue */
|
|
int adbOutHead = 0; /* head of out queue */
|
|
int adbOutTail = 0; /* tail of out queue */
|
|
|
|
int tickle_count = 0; /* how many tickles seen for this packet? */
|
|
int tickle_serial = 0; /* the last packet tickled */
|
|
int adb_cuda_serial = 0; /* the current packet */
|
|
|
|
struct callout adb_cuda_tickle_ch = CALLOUT_INITIALIZER;
|
|
struct callout adb_soft_intr_ch = CALLOUT_INITIALIZER;
|
|
|
|
volatile u_char *Via1Base;
|
|
extern int adb_polling; /* Are we polling? */
|
|
|
|
void pm_setup_adb __P((void));
|
|
void pm_check_adb_devices __P((int));
|
|
void pm_intr __P((void));
|
|
int pm_adb_op __P((u_char *, void *, void *, int));
|
|
void pm_init_adb_device __P((void));
|
|
|
|
/*
|
|
* The following are private routines.
|
|
*/
|
|
#ifdef ADB_DEBUG
|
|
void print_single __P((u_char *));
|
|
#endif
|
|
void adb_intr __P((void));
|
|
void adb_intr_II __P((void));
|
|
void adb_intr_IIsi __P((void));
|
|
void adb_intr_cuda __P((void));
|
|
void adb_soft_intr __P((void));
|
|
int send_adb_II __P((u_char *, u_char *, void *, void *, int));
|
|
int send_adb_IIsi __P((u_char *, u_char *, void *, void *, int));
|
|
int send_adb_cuda __P((u_char *, u_char *, void *, void *, int));
|
|
void adb_intr_cuda_test __P((void));
|
|
void adb_cuda_tickle __P((void));
|
|
void adb_pass_up __P((struct adbCommand *));
|
|
void adb_op_comprout __P((caddr_t, caddr_t, int));
|
|
void adb_reinit __P((void));
|
|
int count_adbs __P((void));
|
|
int get_ind_adb_info __P((ADBDataBlock *, int));
|
|
int get_adb_info __P((ADBDataBlock *, int));
|
|
int set_adb_info __P((ADBSetInfoBlock *, int));
|
|
void adb_setup_hw_type __P((void));
|
|
int adb_op __P((Ptr, Ptr, Ptr, short));
|
|
int adb_op_sync __P((Ptr, Ptr, Ptr, short));
|
|
void adb_read_II __P((u_char *));
|
|
void adb_hw_setup __P((void));
|
|
void adb_hw_setup_IIsi __P((u_char *));
|
|
int adb_cmd_result __P((u_char *));
|
|
int adb_cmd_extra __P((u_char *));
|
|
int adb_guess_next_device __P((void));
|
|
int adb_prog_switch_enable __P((void));
|
|
int adb_prog_switch_disable __P((void));
|
|
/* we should create this and it will be the public version */
|
|
int send_adb __P((u_char *, void *, void *));
|
|
|
|
int setsoftadb __P((void));
|
|
|
|
#ifdef ADB_DEBUG
|
|
/*
|
|
* print_single
|
|
* Diagnostic display routine. Displays the hex values of the
|
|
* specified elements of the u_char. The length of the "string"
|
|
* is in [0].
|
|
*/
|
|
void
|
|
print_single(str)
|
|
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 = 20;
|
|
}
|
|
printf_intr("(length=0x%x):", *str);
|
|
for (x = 1; x <= *str; x++)
|
|
printf_intr(" 0x%02x", str[x]);
|
|
printf_intr("\n");
|
|
}
|
|
#endif
|
|
|
|
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);
|
|
}
|
|
|
|
/*
|
|
* called when when an adb interrupt happens
|
|
*
|
|
* Cuda version of adb_intr
|
|
* TO DO: do we want to add some calls to intr_dispatch() here to
|
|
* grab serial interrupts?
|
|
*/
|
|
void
|
|
adb_intr_cuda(void)
|
|
{
|
|
volatile int i, ending;
|
|
volatile unsigned int s;
|
|
struct adbCommand packet;
|
|
|
|
s = splhigh(); /* can't be too careful - might be called */
|
|
/* from a routine, NOT an interrupt */
|
|
|
|
ADB_VIA_CLR_INTR(); /* clear interrupt */
|
|
ADB_VIA_INTR_DISABLE(); /* disable ADB interrupt on IIs. */
|
|
|
|
switch_start:
|
|
switch (adbActionState) {
|
|
case ADB_ACTION_IDLE:
|
|
/*
|
|
* This is an unexpected packet, so grab the first (dummy)
|
|
* byte, set up the proper vars, and tell the chip we are
|
|
* starting to receive the packet by setting the TIP bit.
|
|
*/
|
|
adbInputBuffer[1] = ADB_SR();
|
|
adb_cuda_serial++;
|
|
if (ADB_INTR_IS_OFF) /* must have been a fake start */
|
|
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();
|
|
/* intr off means this is the last byte (end of frame) */
|
|
if (ADB_INTR_IS_OFF)
|
|
ending = 1;
|
|
else
|
|
ending = 0;
|
|
|
|
if (1 == ending) { /* end of message? */
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug) {
|
|
printf_intr("in end 0x%02x ",
|
|
adbInputBuffer[adbInputBuffer[0]]);
|
|
print_single(adbInputBuffer);
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* Are we waiting AND does this packet match what we
|
|
* are waiting for AND is it coming from either the
|
|
* ADB or RTC/PRAM sub-device? This section _should_
|
|
* recognize all ADB and RTC/PRAM type commands, but
|
|
* there may be more... NOTE: commands are always at
|
|
* [4], even for RTC/PRAM commands.
|
|
*/
|
|
/* set up data for adb_pass_up */
|
|
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; /* reset "waiting" vars */
|
|
adbWaiting = 0;
|
|
adbBuffer = (long)0;
|
|
adbCompRout = (long)0;
|
|
adbCompData = (long)0;
|
|
} else {
|
|
packet.unsol = 1;
|
|
packet.ack_only = 0;
|
|
adb_pass_up(&packet);
|
|
}
|
|
|
|
|
|
/* reset vars and signal the end of this frame */
|
|
adbActionState = ADB_ACTION_IDLE;
|
|
adbInputBuffer[0] = 0;
|
|
ADB_SET_STATE_IDLE_CUDA();
|
|
/*ADB_SET_SR_INPUT();*/
|
|
|
|
/*
|
|
* If there is something waiting to be sent out,
|
|
* the set everything up and send the first byte.
|
|
*/
|
|
if (adbWriteDelay == 1) {
|
|
delay(ADB_DELAY); /* required */
|
|
adbSentChars = 0;
|
|
adbActionState = ADB_ACTION_OUT;
|
|
/*
|
|
* If the interrupt is on, we were too slow
|
|
* and the chip has already started to send
|
|
* something to us, so back out of the write
|
|
* and start a read cycle.
|
|
*/
|
|
if (ADB_INTR_IS_ON) {
|
|
ADB_SET_SR_INPUT();
|
|
ADB_SET_STATE_IDLE_CUDA();
|
|
adbSentChars = 0;
|
|
adbActionState = ADB_ACTION_IDLE;
|
|
adbInputBuffer[0] = 0;
|
|
break;
|
|
}
|
|
/*
|
|
* If we got here, it's ok to start sending
|
|
* so load the first byte and tell the chip
|
|
* we want to send.
|
|
*/
|
|
ADB_SET_STATE_TIP();
|
|
ADB_SET_SR_OUTPUT();
|
|
write_via_reg(VIA1, vSR, 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(); /* reset SR-intr in IFR */
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug)
|
|
printf_intr("intr out 0x%02x ", i);
|
|
#endif
|
|
|
|
adbSentChars++;
|
|
if (ADB_INTR_IS_ON) { /* ADB intr low during write */
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug)
|
|
printf_intr("intr was on ");
|
|
#endif
|
|
ADB_SET_SR_INPUT(); /* make sure SR is set to IN */
|
|
ADB_SET_STATE_IDLE_CUDA();
|
|
adbSentChars = 0; /* must start all over */
|
|
adbActionState = ADB_ACTION_IDLE; /* new state */
|
|
adbInputBuffer[0] = 0;
|
|
adbWriteDelay = 1; /* must retry when done with
|
|
* read */
|
|
delay(ADB_DELAY);
|
|
goto switch_start; /* process next state right
|
|
* now */
|
|
break;
|
|
}
|
|
if (adbOutputBuffer[0] == adbSentChars) { /* check for done */
|
|
if (0 == adb_cmd_result(adbOutputBuffer)) { /* do we expect data
|
|
* back? */
|
|
adbWaiting = 1; /* signal waiting for return */
|
|
adbWaitingCmd = adbOutputBuffer[2]; /* save waiting command */
|
|
} else { /* no talk, so done */
|
|
/* set up stuff for adb_pass_up */
|
|
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);
|
|
|
|
/* reset "waiting" vars, just in case */
|
|
adbWaitingCmd = 0;
|
|
adbBuffer = (long)0;
|
|
adbCompRout = (long)0;
|
|
adbCompData = (long)0;
|
|
}
|
|
|
|
adbWriteDelay = 0; /* done writing */
|
|
adbActionState = ADB_ACTION_IDLE; /* signal bus is idle */
|
|
ADB_SET_SR_INPUT();
|
|
ADB_SET_STATE_IDLE_CUDA();
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug)
|
|
printf_intr("write done ");
|
|
#endif
|
|
} else {
|
|
write_via_reg(VIA1, vSR, adbOutputBuffer[adbSentChars + 1]); /* send next byte */
|
|
ADB_TOGGLE_STATE_ACK_CUDA(); /* signal byte ready to
|
|
* shift */
|
|
#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(); /* enable ADB interrupt on IIs. */
|
|
|
|
splx(s); /* restore */
|
|
|
|
return;
|
|
} /* end adb_intr_cuda */
|
|
|
|
|
|
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;
|
|
|
|
/* Don't interrupt while we are messing with the ADB */
|
|
s = splhigh();
|
|
|
|
if ((adbActionState == ADB_ACTION_IDLE) && /* ADB available? */
|
|
(ADB_INTR_IS_OFF)) { /* and no incoming interrupt? */
|
|
} else
|
|
if (adbWriteDelay == 0) /* it's busy, but is anything waiting? */
|
|
adbWriteDelay = 1; /* if no, then we'll "queue"
|
|
* it up */
|
|
else {
|
|
splx(s);
|
|
return 1; /* really busy! */
|
|
}
|
|
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug)
|
|
printf_intr("QUEUE\n");
|
|
#endif
|
|
if ((long)in == (long)0) { /* need to convert? */
|
|
/*
|
|
* Don't need to use adb_cmd_extra here because this section
|
|
* will be called ONLY when it is an ADB command (no RTC or
|
|
* PRAM)
|
|
*/
|
|
if ((command & 0x0c) == 0x08) /* copy addl data ONLY if
|
|
* doing a listen! */
|
|
len = buffer[0]; /* length of additional data */
|
|
else
|
|
len = 0;/* no additional data */
|
|
|
|
adbOutputBuffer[0] = 2 + len; /* dev. type + command + addl.
|
|
* data */
|
|
adbOutputBuffer[1] = 0x00; /* mark as an ADB command */
|
|
adbOutputBuffer[2] = (u_char)command; /* load command */
|
|
|
|
/* copy additional output data, if any */
|
|
memcpy(adbOutputBuffer + 3, buffer + 1, len);
|
|
} else
|
|
/* if data ready, just copy over */
|
|
memcpy(adbOutputBuffer, in, in[0] + 2);
|
|
|
|
adbSentChars = 0; /* nothing sent yet */
|
|
adbBuffer = buffer; /* save buffer to know where to save result */
|
|
adbCompRout = compRout; /* save completion routine pointer */
|
|
adbCompData = data; /* save completion routine data pointer */
|
|
adbWaitingCmd = adbOutputBuffer[2]; /* save wait command */
|
|
|
|
if (adbWriteDelay != 1) { /* start command now? */
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug)
|
|
printf_intr("out start NOW");
|
|
#endif
|
|
delay(ADB_DELAY);
|
|
adbActionState = ADB_ACTION_OUT; /* set next state */
|
|
ADB_SET_SR_OUTPUT(); /* set shift register for OUT */
|
|
write_via_reg(VIA1, vSR, adbOutputBuffer[adbSentChars + 1]); /* load byte for output */
|
|
ADB_SET_STATE_ACKOFF_CUDA();
|
|
ADB_SET_STATE_TIP(); /* tell ADB that we want to send */
|
|
}
|
|
adbWriteDelay = 1; /* something in the write "queue" */
|
|
|
|
splx(s);
|
|
|
|
if ((s & (1 << 18)) || adb_polling) /* XXX were VIA1 interrupts blocked ? */
|
|
/* poll until byte done */
|
|
while ((adbActionState != ADB_ACTION_IDLE) || (ADB_INTR_IS_ON)
|
|
|| (adbWaiting == 1))
|
|
if (ADB_SR_INTR_IS_ON) { /* wait for "interrupt" */
|
|
adb_intr_cuda(); /* process it */
|
|
adb_soft_intr();
|
|
}
|
|
|
|
return 0;
|
|
} /* send_adb_cuda */
|
|
|
|
|
|
void
|
|
adb_intr_II(void)
|
|
{
|
|
panic("adb_intr_II");
|
|
}
|
|
|
|
|
|
/*
|
|
* send_adb version for II series machines
|
|
*/
|
|
int
|
|
send_adb_II(u_char * in, u_char * buffer, void *compRout, void *data, int command)
|
|
{
|
|
panic("send_adb_II");
|
|
}
|
|
|
|
|
|
/*
|
|
* This routine is called from the II series interrupt routine
|
|
* to determine what the "next" device is that should be polled.
|
|
*/
|
|
int
|
|
adb_guess_next_device(void)
|
|
{
|
|
int last, i, dummy;
|
|
|
|
if (adbStarting) {
|
|
/*
|
|
* Start polling EVERY device, since we can't be sure there is
|
|
* anything in the device table yet
|
|
*/
|
|
if (adbLastDevice < 1 || adbLastDevice > 15)
|
|
adbLastDevice = 1;
|
|
if (++adbLastDevice > 15) /* point to next one */
|
|
adbLastDevice = 1;
|
|
} else {
|
|
/* find the next device using the device table */
|
|
if (adbLastDevice < 1 || adbLastDevice > 15) /* let's be parinoid */
|
|
adbLastDevice = 2;
|
|
last = 1; /* default index location */
|
|
|
|
for (i = 1; i < 16; i++) /* find index entry */
|
|
if (ADBDevTable[i].currentAddr == adbLastDevice) { /* look for device */
|
|
last = i; /* found it */
|
|
break;
|
|
}
|
|
dummy = last; /* index to start at */
|
|
for (;;) { /* find next device in index */
|
|
if (++dummy > 15) /* wrap around if needed */
|
|
dummy = 1;
|
|
if (dummy == last) { /* didn't find any other
|
|
* device! This can happen if
|
|
* there are no devices on the
|
|
* bus */
|
|
dummy = 1;
|
|
break;
|
|
}
|
|
/* found the next device */
|
|
if (ADBDevTable[dummy].devType != 0)
|
|
break;
|
|
}
|
|
adbLastDevice = ADBDevTable[dummy].currentAddr;
|
|
}
|
|
return adbLastDevice;
|
|
}
|
|
|
|
|
|
/*
|
|
* Called when when an adb interrupt happens.
|
|
* This routine simply transfers control over to the appropriate
|
|
* code for the machine we are running on.
|
|
*/
|
|
void
|
|
adb_intr(void)
|
|
{
|
|
switch (adbHardware) {
|
|
case ADB_HW_II:
|
|
adb_intr_II();
|
|
break;
|
|
|
|
case ADB_HW_IISI:
|
|
adb_intr_IIsi();
|
|
break;
|
|
|
|
case ADB_HW_PB:
|
|
pm_intr();
|
|
break;
|
|
|
|
case ADB_HW_CUDA:
|
|
adb_intr_cuda();
|
|
break;
|
|
|
|
case ADB_HW_UNKNOWN:
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* called when when an adb interrupt happens
|
|
*
|
|
* IIsi version of adb_intr
|
|
*
|
|
*/
|
|
void
|
|
adb_intr_IIsi(void)
|
|
{
|
|
panic("adb_intr_IIsi");
|
|
}
|
|
|
|
|
|
/*****************************************************************************
|
|
* if the device is currently busy, and there is no data waiting to go out, then
|
|
* the data is "queued" in the outgoing buffer. If we are already waiting, then
|
|
* we return.
|
|
* in: if (in == 0) then the command string is built from command and buffer
|
|
* if (in != 0) then in is used as the command string
|
|
* buffer: additional data to be sent (used only if in == 0)
|
|
* this is also where return data is stored
|
|
* compRout: the completion routine that is called when then return value
|
|
* is received (if a return value is expected)
|
|
* data: a data pointer that can be used by the completion routine
|
|
* command: an ADB command to be sent (used only if in == 0)
|
|
*
|
|
*/
|
|
int
|
|
send_adb_IIsi(u_char * in, u_char * buffer, void *compRout, void *data, int
|
|
command)
|
|
{
|
|
panic("send_adb_IIsi");
|
|
}
|
|
|
|
|
|
/*
|
|
* adb_pass_up is called by the interrupt-time routines.
|
|
* It takes the raw packet data that was received from the
|
|
* device and puts it into the queue that the upper half
|
|
* processes. It then signals for a soft ADB interrupt which
|
|
* will eventually call the upper half routine (adb_soft_intr).
|
|
*
|
|
* If in->unsol is 0, then this is either the notification
|
|
* that the packet was sent (on a LISTEN, for example), or the
|
|
* response from the device (on a TALK). The completion routine
|
|
* is called only if the user specified one.
|
|
*
|
|
* If in->unsol is 1, then this packet was unsolicited and
|
|
* so we look up the device in the ADB device table to determine
|
|
* what it's default service routine is.
|
|
*
|
|
* If in->ack_only is 1, then we really only need to call
|
|
* the completion routine, so don't do any other stuff.
|
|
*
|
|
* Note that in->data contains the packet header AND data,
|
|
* while adbInbound[]->data contains ONLY data.
|
|
*
|
|
* Note: Called only at interrupt time. Assumes this.
|
|
*/
|
|
void
|
|
adb_pass_up(struct adbCommand *in)
|
|
{
|
|
int start = 0, len = 0, cmd = 0;
|
|
ADBDataBlock block;
|
|
|
|
/* temp for testing */
|
|
/*u_char *buffer = 0;*/
|
|
/*u_char *compdata = 0;*/
|
|
/*u_char *comprout = 0;*/
|
|
|
|
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_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 it's unsolicited, accept only ADB data for now */
|
|
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;
|
|
}
|
|
|
|
/* Make sure there is a valid device entry for this device */
|
|
if (in->unsol) {
|
|
/* ignore unsolicited data during adbreinit */
|
|
if (adbStarting)
|
|
return;
|
|
/* get device's comp. routine and data area */
|
|
if (-1 == get_adb_info(&block, ADB_CMDADDR(cmd)))
|
|
return;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* If this is an unsolicited packet, we need to fill in
|
|
* some info so adb_soft_intr can process this packet
|
|
* properly. If it's not unsolicited, then use what
|
|
* the caller sent us.
|
|
*/
|
|
if (in->unsol) {
|
|
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
|
|
|
|
/* copy the packet data over */
|
|
/*
|
|
* TO DO: If the *_intr routines fed their incoming data
|
|
* directly into an adbCommand struct, which is passed to
|
|
* this routine, then we could eliminate this copy.
|
|
*/
|
|
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 the debugger is running, call upper half manually.
|
|
* Otherwise, trigger a soft interrupt to handle the rest later.
|
|
*/
|
|
if (adb_polling)
|
|
adb_soft_intr();
|
|
else
|
|
setsoftadb();
|
|
|
|
return;
|
|
}
|
|
|
|
|
|
/*
|
|
* Called to process the packets after they have been
|
|
* placed in the incoming queue.
|
|
*
|
|
*/
|
|
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
|
|
|
|
/*delay(2*ADB_DELAY);*/
|
|
|
|
while (adbInCount) {
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug & 0x80)
|
|
printf_intr("%x %x %x ",
|
|
adbInCount, adbInHead, adbInTail);
|
|
#endif
|
|
/* get the data we need from the queue */
|
|
buffer = adbInbound[adbInHead].saveBuf;
|
|
comprout = adbInbound[adbInHead].compRout;
|
|
compdata = adbInbound[adbInHead].compData;
|
|
cmd = adbInbound[adbInHead].cmd;
|
|
|
|
/* copy over data to data area if it's valid */
|
|
/*
|
|
* Note that for unsol packets we don't want to copy the
|
|
* data anywhere, so buffer was already set to 0.
|
|
* For ack_only buffer was set to 0, so don't copy.
|
|
*/
|
|
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
|
|
/* Remove the packet from the queue before calling
|
|
* the completion routine, so that the completion
|
|
* routine can reentrantly process the queue. For
|
|
* example, this happens when polling is turned on
|
|
* by entering the debuger by keystroke.
|
|
*/
|
|
s = splhigh();
|
|
adbInCount--;
|
|
if (++adbInHead >= ADB_QUEUE)
|
|
adbInHead = 0;
|
|
splx(s);
|
|
|
|
/* call default completion routine if it's valid */
|
|
if (comprout) {
|
|
void (*f)(caddr_t, caddr_t, int) =
|
|
(void (*)(caddr_t, caddr_t, int))comprout;
|
|
|
|
(*f)(buffer, compdata, cmd);
|
|
}
|
|
}
|
|
return;
|
|
}
|
|
|
|
|
|
/*
|
|
* This is my version of the ADBOp routine. It mainly just calls the
|
|
* hardware-specific routine.
|
|
*
|
|
* data : pointer to data area to be used by compRout
|
|
* compRout : completion routine
|
|
* buffer : for LISTEN: points to data to send - MAX 8 data bytes,
|
|
* byte 0 = # of bytes
|
|
* : for TALK: points to place to save return data
|
|
* command : the adb command to send
|
|
* result : 0 = success
|
|
* : -1 = could not complete
|
|
*/
|
|
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_IISI:
|
|
result = send_adb_IIsi((u_char *)0, (u_char *)buffer,
|
|
(void *)compRout, (void *)data, (int)command);
|
|
/*
|
|
* I wish I knew why this delay is needed. It usually needs to
|
|
* be here when several commands are sent in close succession,
|
|
* especially early in device probes when doing collision
|
|
* detection. It must be some race condition. Sigh. - jpw
|
|
*/
|
|
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;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* adb_hw_setup
|
|
* This routine sets up the possible machine specific hardware
|
|
* config (mainly VIA settings) for the various models.
|
|
*/
|
|
void
|
|
adb_hw_setup(void)
|
|
{
|
|
volatile int i;
|
|
u_char send_string[ADB_MAX_MSG_LENGTH];
|
|
|
|
switch (adbHardware) {
|
|
case ADB_HW_II:
|
|
via_reg_or(VIA1, vDirB, 0x30); /* register B bits 4 and 5:
|
|
* outputs */
|
|
via_reg_and(VIA1, vDirB, 0xf7); /* register B bit 3: input */
|
|
via_reg_and(VIA1, vACR, ~vSR_OUT); /* make sure SR is set
|
|
* to IN (II, IIsi) */
|
|
adbActionState = ADB_ACTION_IDLE; /* used by all types of
|
|
* hardware (II, IIsi) */
|
|
adbBusState = ADB_BUS_IDLE; /* this var. used in II-series
|
|
* code only */
|
|
write_via_reg(VIA1, vIER, 0x84);/* make sure VIA interrupts
|
|
* are on (II, IIsi) */
|
|
ADB_SET_STATE_IDLE_II(); /* set ADB bus state to idle */
|
|
|
|
ADB_VIA_CLR_INTR(); /* clear interrupt */
|
|
break;
|
|
|
|
case ADB_HW_IISI:
|
|
via_reg_or(VIA1, vDirB, 0x30); /* register B bits 4 and 5:
|
|
* outputs */
|
|
via_reg_and(VIA1, vDirB, 0xf7); /* register B bit 3: input */
|
|
via_reg_and(VIA1, vACR, ~vSR_OUT); /* make sure SR is set
|
|
* to IN (II, IIsi) */
|
|
adbActionState = ADB_ACTION_IDLE; /* used by all types of
|
|
* hardware (II, IIsi) */
|
|
adbBusState = ADB_BUS_IDLE; /* this var. used in II-series
|
|
* code only */
|
|
write_via_reg(VIA1, vIER, 0x84);/* make sure VIA interrupts
|
|
* are on (II, IIsi) */
|
|
ADB_SET_STATE_IDLE_IISI(); /* set ADB bus state to idle */
|
|
|
|
/* get those pesky clock ticks we missed while booting */
|
|
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:
|
|
/*
|
|
* XXX - really PM_VIA_CLR_INTR - should we put it in
|
|
* pm_direct.h?
|
|
*/
|
|
write_via_reg(VIA1, vIFR, 0x90); /* clear interrupt */
|
|
break;
|
|
|
|
case ADB_HW_CUDA:
|
|
via_reg_or(VIA1, vDirB, 0x30); /* register B bits 4 and 5:
|
|
* outputs */
|
|
via_reg_and(VIA1, vDirB, 0xf7); /* register B bit 3: input */
|
|
via_reg_and(VIA1, vACR, ~vSR_OUT); /* make sure SR is set
|
|
* to IN */
|
|
write_via_reg(VIA1, vACR, (read_via_reg(VIA1, vACR) | 0x0c) & ~0x10);
|
|
adbActionState = ADB_ACTION_IDLE; /* used by all types of
|
|
* hardware */
|
|
adbBusState = ADB_BUS_IDLE; /* this var. used in II-series
|
|
* code only */
|
|
write_via_reg(VIA1, vIER, 0x84);/* make sure VIA interrupts
|
|
* are on */
|
|
ADB_SET_STATE_IDLE_CUDA(); /* set ADB bus state to idle */
|
|
|
|
/* sort of a device reset */
|
|
i = ADB_SR(); /* clear interrupt */
|
|
ADB_VIA_INTR_DISABLE(); /* no interrupts while clearing */
|
|
ADB_SET_STATE_IDLE_CUDA(); /* reset state to idle */
|
|
delay(ADB_DELAY);
|
|
ADB_SET_STATE_TIP(); /* signal start of frame */
|
|
delay(ADB_DELAY);
|
|
ADB_TOGGLE_STATE_ACK_CUDA();
|
|
delay(ADB_DELAY);
|
|
ADB_CLR_STATE_TIP();
|
|
delay(ADB_DELAY);
|
|
ADB_SET_STATE_IDLE_CUDA(); /* back to idle state */
|
|
i = ADB_SR(); /* clear interrupt */
|
|
ADB_VIA_INTR_ENABLE(); /* ints ok now */
|
|
break;
|
|
|
|
case ADB_HW_UNKNOWN:
|
|
default:
|
|
write_via_reg(VIA1, vIER, 0x04);/* turn interrupts off - TO
|
|
* DO: turn PB ints off? */
|
|
return;
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* adb_hw_setup_IIsi
|
|
* This is sort of a "read" routine that forces the adb hardware through a read cycle
|
|
* if there is something waiting. This helps "clean up" any commands that may have gotten
|
|
* stuck or stopped during the boot process.
|
|
*
|
|
*/
|
|
void
|
|
adb_hw_setup_IIsi(u_char * buffer)
|
|
{
|
|
panic("adb_hw_setup_IIsi");
|
|
}
|
|
|
|
|
|
/*
|
|
* adb_reinit sets up the adb stuff
|
|
*
|
|
*/
|
|
void
|
|
adb_reinit(void)
|
|
{
|
|
u_char send_string[ADB_MAX_MSG_LENGTH];
|
|
ADBDataBlock data; /* temp. holder for getting device info */
|
|
volatile int i, x;
|
|
int s;
|
|
int command;
|
|
int result;
|
|
int saveptr; /* point to next free relocation address */
|
|
int device;
|
|
int nonewtimes; /* times thru loop w/o any new devices */
|
|
|
|
/* Make sure we are not interrupted while building the table. */
|
|
if (adbHardware != ADB_HW_PB) /* ints must be on for PB? */
|
|
s = splhigh();
|
|
|
|
ADBNumDevices = 0; /* no devices yet */
|
|
|
|
/* Let intr routines know we are running reinit */
|
|
adbStarting = 1;
|
|
|
|
/*
|
|
* Initialize the ADB table. For now, we'll always use the same table
|
|
* that is defined at the beginning of this file - no mallocs.
|
|
*/
|
|
for (i = 0; i < 16; i++)
|
|
ADBDevTable[i].devType = 0;
|
|
|
|
adb_setup_hw_type(); /* setup hardware type */
|
|
|
|
adb_hw_setup(); /* init the VIA bits and hard reset ADB */
|
|
|
|
delay(1000);
|
|
|
|
/* send an ADB reset first */
|
|
result = adb_op_sync((Ptr)0, (Ptr)0, (Ptr)0, (short)0x00);
|
|
delay(200000);
|
|
|
|
#ifdef ADB_DEBUG
|
|
if (result && adb_debug) {
|
|
printf_intr("adb_reinit: failed to reset, result = %d\n",result);
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* Probe for ADB devices. Probe devices 1-15 quickly to determine
|
|
* which device addresses are in use and which are free. For each
|
|
* address that is in use, move the device at that address to a higher
|
|
* free address. Continue doing this at that address until no device
|
|
* responds at that address. Then move the last device that was moved
|
|
* back to the original address. Do this for the remaining addresses
|
|
* that we determined were in use.
|
|
*
|
|
* When finished, do this entire process over again with the updated
|
|
* list of in use addresses. Do this until no new devices have been
|
|
* found in 20 passes though the in use address list. (This probably
|
|
* seems long and complicated, but it's the best way to detect multiple
|
|
* devices at the same address - sometimes it takes a couple of tries
|
|
* before the collision is detected.)
|
|
*/
|
|
|
|
/* initial scan through the devices */
|
|
for (i = 1; i < 16; i++) {
|
|
send_string[0] = 0;
|
|
command = ADBTALK(i, 3);
|
|
result = adb_op_sync((Ptr)send_string, (Ptr)0,
|
|
(Ptr)0, (short)command);
|
|
|
|
#ifdef ADB_DEBUG
|
|
if (result && adb_debug) {
|
|
printf_intr("adb_reinit: scan of device %d, result = %d, str = 0x%x\n",
|
|
i,result,send_string[0]);
|
|
}
|
|
#endif
|
|
|
|
if (send_string[0] != 0) {
|
|
/* check for valid device handler */
|
|
switch (send_string[2]) {
|
|
case 0:
|
|
case 0xfd:
|
|
case 0xfe:
|
|
case 0xff:
|
|
continue; /* invalid, skip */
|
|
}
|
|
|
|
/* found a device */
|
|
++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); /* tell pm driver device
|
|
* is here */
|
|
}
|
|
}
|
|
|
|
/* find highest unused address */
|
|
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; /* no loops w/o new devices */
|
|
while (saveptr > 0 && nonewtimes++ < 11) {
|
|
for (i = 1; 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
|
|
|
|
/* send TALK R3 to address */
|
|
command = ADBTALK(device, 3);
|
|
adb_op_sync((Ptr)send_string, (Ptr)0,
|
|
(Ptr)0, (short)command);
|
|
|
|
/* move device to higher address */
|
|
command = ADBLISTEN(device, 3);
|
|
send_string[0] = 2;
|
|
send_string[1] = (u_char)(saveptr | 0x60);
|
|
send_string[2] = 0xfe;
|
|
adb_op_sync((Ptr)send_string, (Ptr)0,
|
|
(Ptr)0, (short)command);
|
|
delay(500);
|
|
|
|
/* send TALK R3 - anything at new address? */
|
|
command = ADBTALK(saveptr, 3);
|
|
adb_op_sync((Ptr)send_string, (Ptr)0,
|
|
(Ptr)0, (short)command);
|
|
delay(500);
|
|
|
|
if (send_string[0] == 0) {
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug & 0x80)
|
|
printf_intr("failed, continuing\n");
|
|
#endif
|
|
continue;
|
|
}
|
|
|
|
/* send TALK R3 - anything at old address? */
|
|
command = ADBTALK(device, 3);
|
|
result = adb_op_sync((Ptr)send_string, (Ptr)0,
|
|
(Ptr)0, (short)command);
|
|
if (send_string[0] != 0) {
|
|
/* check for valid device handler */
|
|
switch (send_string[2]) {
|
|
case 0:
|
|
case 0xfd:
|
|
case 0xfe:
|
|
case 0xff:
|
|
continue; /* invalid, skip */
|
|
}
|
|
|
|
/* new device found */
|
|
/* update data for previously moved device */
|
|
ADBDevTable[i].currentAddr = saveptr;
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug & 0x80)
|
|
printf_intr("old device at index %i\n",i);
|
|
#endif
|
|
/* add new device in table */
|
|
#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;
|
|
/* These will be set correctly in adbsys.c */
|
|
/* Until then, unsol. data will be ignored. */
|
|
ADBDevTable[ADBNumDevices].DataAreaAddr =
|
|
(long)0;
|
|
ADBDevTable[ADBNumDevices].ServiceRtPtr =
|
|
(void *)0;
|
|
/* find next unused address */
|
|
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;
|
|
/* tell pm driver device is here */
|
|
pm_check_adb_devices(device);
|
|
} else {
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug & 0x80)
|
|
printf_intr("moving back...\n");
|
|
#endif
|
|
/* move old device back */
|
|
command = ADBLISTEN(saveptr, 3);
|
|
send_string[0] = 2;
|
|
send_string[1] = (u_char)(device | 0x60);
|
|
send_string[2] = 0xfe;
|
|
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%x\n",
|
|
i, x, data.devType);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
#ifndef MRG_ADB
|
|
/* enable the programmer's switch, if we have one */
|
|
adb_prog_switch_enable();
|
|
#endif
|
|
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug) {
|
|
if (0 == ADBNumDevices) /* tell user if no devices found */
|
|
printf_intr("adb: no devices found\n");
|
|
}
|
|
#endif
|
|
|
|
adbStarting = 0; /* not starting anymore */
|
|
#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) /* ints must be on for PB? */
|
|
splx(s);
|
|
}
|
|
|
|
/*
|
|
* adb_cmd_result
|
|
*
|
|
* This routine lets the caller know whether the specified adb command string
|
|
* should expect a returned result, such as a TALK command.
|
|
*
|
|
* returns: 0 if a result should be expected
|
|
* 1 if a result should NOT be expected
|
|
*/
|
|
int
|
|
adb_cmd_result(u_char *in)
|
|
{
|
|
switch (adbHardware) {
|
|
case ADB_HW_II:
|
|
/* was it an ADB talk command? */
|
|
if ((in[1] & 0x0c) == 0x0c)
|
|
return 0;
|
|
return 1;
|
|
|
|
case ADB_HW_IISI:
|
|
case ADB_HW_CUDA:
|
|
/* was it an ADB talk command? */
|
|
if ((in[1] == 0x00) && ((in[2] & 0x0c) == 0x0c))
|
|
return 0;
|
|
/* was it an RTC/PRAM read date/time? */
|
|
if ((in[1] == 0x01) && (in[2] == 0x03))
|
|
return 0;
|
|
return 1;
|
|
|
|
case ADB_HW_PB:
|
|
return 1;
|
|
|
|
case ADB_HW_UNKNOWN:
|
|
default:
|
|
return 1;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* adb_cmd_extra
|
|
*
|
|
* This routine lets the caller know whether the specified adb command string
|
|
* may have extra data appended to the end of it, such as a LISTEN command.
|
|
*
|
|
* returns: 0 if extra data is allowed
|
|
* 1 if extra data is NOT allowed
|
|
*/
|
|
int
|
|
adb_cmd_extra(u_char *in)
|
|
{
|
|
switch (adbHardware) {
|
|
case ADB_HW_II:
|
|
if ((in[1] & 0x0c) == 0x08) /* was it a listen command? */
|
|
return 0;
|
|
return 1;
|
|
|
|
case ADB_HW_IISI:
|
|
case ADB_HW_CUDA:
|
|
/*
|
|
* TO DO: support needs to be added to recognize RTC and PRAM
|
|
* commands
|
|
*/
|
|
if ((in[2] & 0x0c) == 0x08) /* was it a listen command? */
|
|
return 0;
|
|
/* add others later */
|
|
return 1;
|
|
|
|
case ADB_HW_PB:
|
|
return 1;
|
|
|
|
case ADB_HW_UNKNOWN:
|
|
default:
|
|
return 1;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* adb_op_sync
|
|
*
|
|
* This routine does exactly what the adb_op routine does, except that after
|
|
* the adb_op is called, it waits until the return value is present before
|
|
* returning.
|
|
*
|
|
* NOTE: The user specified compRout is ignored, since this routine specifies
|
|
* it's own to adb_op, which is why you really called this in the first place
|
|
* anyway.
|
|
*/
|
|
int
|
|
adb_op_sync(Ptr buffer, Ptr compRout, Ptr data, short command)
|
|
{
|
|
int tmout;
|
|
int result;
|
|
volatile int flag = 0;
|
|
|
|
result = adb_op(buffer, (void *)adb_op_comprout,
|
|
(void *)&flag, command); /* send command */
|
|
if (result == 0) { /* send ok? */
|
|
/*
|
|
* Total time to wait is calculated as follows:
|
|
* - Tlt (stop to start time): 260 usec
|
|
* - start bit: 100 usec
|
|
* - up to 8 data bytes: 64 * 100 usec = 6400 usec
|
|
* - stop bit (with SRQ): 140 usec
|
|
* Total: 6900 usec
|
|
*
|
|
* This is the total time allowed by the specification. Any
|
|
* device that doesn't conform to this will fail to operate
|
|
* properly on some Apple systems. In spite of this we
|
|
* double the time to wait; some Cuda-based apparently
|
|
* queues some commands and allows the main CPU to continue
|
|
* processing (radical concept, eh?). To be safe, allow
|
|
* time for two complete ADB transactions to occur.
|
|
*/
|
|
for (tmout = 13800; !flag && tmout >= 10; tmout -= 10)
|
|
delay(10);
|
|
if (!flag && tmout > 0)
|
|
delay(tmout);
|
|
|
|
if (!flag)
|
|
result = -2;
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
/*
|
|
* adb_op_comprout
|
|
*
|
|
* This function is used by the adb_op_sync routine so it knows when the
|
|
* function is done.
|
|
*/
|
|
void
|
|
adb_op_comprout(buffer, compdata, cmd)
|
|
caddr_t buffer, compdata;
|
|
int cmd;
|
|
{
|
|
short *p = (short *)compdata;
|
|
|
|
*p = 1;
|
|
}
|
|
|
|
void
|
|
adb_setup_hw_type(void)
|
|
{
|
|
switch (adbHardware) {
|
|
case ADB_HW_CUDA:
|
|
adbSoftPower = 1;
|
|
return;
|
|
|
|
case ADB_HW_PB:
|
|
adbSoftPower = 1;
|
|
pm_setup_adb();
|
|
return;
|
|
|
|
default:
|
|
panic("unknown adb hardware");
|
|
}
|
|
#if 0
|
|
response = 0; /*mac68k_machine.machineid;*/
|
|
|
|
/*
|
|
* Determine what type of ADB hardware we are running on.
|
|
*/
|
|
switch (response) {
|
|
case MACH_MACC610: /* Centris 610 */
|
|
case MACH_MACC650: /* Centris 650 */
|
|
case MACH_MACII: /* II */
|
|
case MACH_MACIICI: /* IIci */
|
|
case MACH_MACIICX: /* IIcx */
|
|
case MACH_MACIIX: /* IIx */
|
|
case MACH_MACQ610: /* Quadra 610 */
|
|
case MACH_MACQ650: /* Quadra 650 */
|
|
case MACH_MACQ700: /* Quadra 700 */
|
|
case MACH_MACQ800: /* Quadra 800 */
|
|
case MACH_MACSE30: /* SE/30 */
|
|
adbHardware = ADB_HW_II;
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug)
|
|
printf_intr("adb: using II series hardware support\n");
|
|
#endif
|
|
break;
|
|
|
|
case MACH_MACCLASSICII: /* Classic II */
|
|
case MACH_MACLCII: /* LC II, Performa 400/405/430 */
|
|
case MACH_MACLCIII: /* LC III, Performa 450 */
|
|
case MACH_MACIISI: /* IIsi */
|
|
case MACH_MACIIVI: /* IIvi */
|
|
case MACH_MACIIVX: /* IIvx */
|
|
case MACH_MACP460: /* Performa 460/465/467 */
|
|
case MACH_MACP600: /* Performa 600 */
|
|
adbHardware = ADB_HW_IISI;
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug)
|
|
printf_intr("adb: using IIsi series hardware support\n");
|
|
#endif
|
|
break;
|
|
|
|
case MACH_MACPB140: /* PowerBook 140 */
|
|
case MACH_MACPB145: /* PowerBook 145 */
|
|
case MACH_MACPB150: /* PowerBook 150 */
|
|
case MACH_MACPB160: /* PowerBook 160 */
|
|
case MACH_MACPB165: /* PowerBook 165 */
|
|
case MACH_MACPB165C: /* PowerBook 165c */
|
|
case MACH_MACPB170: /* PowerBook 170 */
|
|
case MACH_MACPB180: /* PowerBook 180 */
|
|
case MACH_MACPB180C: /* PowerBook 180c */
|
|
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_MACPB210: /* PowerBook Duo 210 */
|
|
case MACH_MACPB230: /* PowerBook Duo 230 */
|
|
case MACH_MACPB250: /* PowerBook Duo 250 */
|
|
case MACH_MACPB270: /* PowerBook Duo 270 */
|
|
case MACH_MACPB280: /* PowerBook Duo 280 */
|
|
case MACH_MACPB280C: /* PowerBook Duo 280c */
|
|
case MACH_MACPB500: /* PowerBook 500 series */
|
|
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: /* Centris 660AV */
|
|
case MACH_MACCCLASSIC: /* Color Classic */
|
|
case MACH_MACCCLASSICII: /* Color Classic II */
|
|
case MACH_MACLC475: /* LC 475, Performa 475/476 */
|
|
case MACH_MACLC475_33: /* Clock-chipped 47x */
|
|
case MACH_MACLC520: /* LC 520 */
|
|
case MACH_MACLC575: /* LC 575, Performa 575/577/578 */
|
|
case MACH_MACP550: /* LC 550, Performa 550 */
|
|
case MACH_MACP580: /* Performa 580/588 */
|
|
case MACH_MACQ605: /* Quadra 605 */
|
|
case MACH_MACQ605_33: /* Clock-chipped Quadra 605 */
|
|
case MACH_MACQ630: /* LC 630, Performa 630, Quadra 630 */
|
|
case MACH_MACQ840AV: /* Quadra 840AV */
|
|
adbHardware = ADB_HW_CUDA;
|
|
#ifdef ADB_DEBUG
|
|
if (adb_debug)
|
|
printf_intr("adb: using Cuda series hardware support\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;
|
|
}
|
|
|
|
/*
|
|
* Determine whether this machine has ADB based soft power.
|
|
*/
|
|
switch (response) {
|
|
case MACH_MACCCLASSIC: /* Color Classic */
|
|
case MACH_MACCCLASSICII: /* Color Classic II */
|
|
case MACH_MACIISI: /* IIsi */
|
|
case MACH_MACIIVI: /* IIvi */
|
|
case MACH_MACIIVX: /* IIvx */
|
|
case MACH_MACLC520: /* LC 520 */
|
|
case MACH_MACLC575: /* LC 575, Performa 575/577/578 */
|
|
case MACH_MACP550: /* LC 550, Performa 550 */
|
|
case MACH_MACP600: /* Performa 600 */
|
|
case MACH_MACQ630: /* LC 630, Performa 630, Quadra 630 */
|
|
case MACH_MACQ840AV: /* Quadra 840AV */
|
|
adbSoftPower = 1;
|
|
break;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
int
|
|
count_adbs(void)
|
|
{
|
|
int i;
|
|
int found;
|
|
|
|
found = 0;
|
|
|
|
for (i = 1; i < 16; i++)
|
|
if (0 != ADBDevTable[i].devType)
|
|
found++;
|
|
|
|
return found;
|
|
}
|
|
|
|
int
|
|
get_ind_adb_info(ADBDataBlock * info, int index)
|
|
{
|
|
if ((index < 1) || (index > 15)) /* check range 1-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) /* make sure it's a valid entry */
|
|
return (-1);
|
|
|
|
info->devType = ADBDevTable[index].devType;
|
|
info->origADBAddr = 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)) /* check range 1-15 */
|
|
return (-1);
|
|
|
|
for (i = 1; i < 15; i++)
|
|
if (ADBDevTable[i].currentAddr == adbAddr) {
|
|
info->devType = ADBDevTable[i].devType;
|
|
info->origADBAddr = ADBDevTable[i].origAddr;
|
|
info->dbServiceRtPtr = (Ptr)ADBDevTable[i].ServiceRtPtr;
|
|
info->dbDataAreaAddr = ADBDevTable[i].DataAreaAddr;
|
|
return 0; /* found */
|
|
}
|
|
|
|
return (-1); /* not found */
|
|
}
|
|
|
|
int
|
|
set_adb_info(ADBSetInfoBlock * info, int adbAddr)
|
|
{
|
|
int i;
|
|
|
|
if ((adbAddr < 1) || (adbAddr > 15)) /* check range 1-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; /* found */
|
|
}
|
|
|
|
return (-1); /* not found */
|
|
|
|
}
|
|
|
|
#ifndef MRG_ADB
|
|
|
|
/* caller should really use machine-independant version: getPramTime */
|
|
/* this version does pseudo-adb access only */
|
|
int
|
|
adb_read_date_time(unsigned long *time)
|
|
{
|
|
u_char output[ADB_MAX_MSG_LENGTH];
|
|
int result;
|
|
volatile int flag = 0;
|
|
|
|
switch (adbHardware) {
|
|
case ADB_HW_II:
|
|
return -1;
|
|
|
|
case ADB_HW_IISI:
|
|
output[0] = 0x02; /* 2 byte message */
|
|
output[1] = 0x01; /* to pram/rtc device */
|
|
output[2] = 0x03; /* read date/time */
|
|
result = send_adb_IIsi((u_char *)output, (u_char *)output,
|
|
(void *)adb_op_comprout, (int *)&flag, (int)0);
|
|
if (result != 0) /* exit if not sent */
|
|
return -1;
|
|
|
|
while (0 == flag) /* wait for result */
|
|
;
|
|
|
|
*time = (long)(*(long *)(output + 1));
|
|
return 0;
|
|
|
|
case ADB_HW_PB:
|
|
pm_read_date_time(time);
|
|
return 0;
|
|
|
|
case ADB_HW_CUDA:
|
|
output[0] = 0x02; /* 2 byte message */
|
|
output[1] = 0x01; /* to pram/rtc device */
|
|
output[2] = 0x03; /* read date/time */
|
|
result = send_adb_cuda((u_char *)output, (u_char *)output,
|
|
(void *)adb_op_comprout, (void *)&flag, (int)0);
|
|
if (result != 0) /* exit if not sent */
|
|
return -1;
|
|
|
|
while (0 == flag) /* wait for result */
|
|
;
|
|
|
|
/* XXX to avoid wrong reordering by gcc 2.95.x with -fgcse */
|
|
__asm volatile ("" ::: "memory");
|
|
|
|
memcpy(time, output + 1, 4);
|
|
return 0;
|
|
|
|
case ADB_HW_UNKNOWN:
|
|
default:
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
/* caller should really use machine-independant version: setPramTime */
|
|
/* this version does pseudo-adb access only */
|
|
int
|
|
adb_set_date_time(unsigned long time)
|
|
{
|
|
u_char output[ADB_MAX_MSG_LENGTH];
|
|
int result;
|
|
volatile int flag = 0;
|
|
|
|
switch (adbHardware) {
|
|
|
|
case ADB_HW_CUDA:
|
|
output[0] = 0x06; /* 6 byte message */
|
|
output[1] = 0x01; /* to pram/rtc device */
|
|
output[2] = 0x09; /* set date/time */
|
|
output[3] = (u_char)(time >> 24);
|
|
output[4] = (u_char)(time >> 16);
|
|
output[5] = (u_char)(time >> 8);
|
|
output[6] = (u_char)(time);
|
|
result = send_adb_cuda((u_char *)output, (u_char *)0,
|
|
(void *)adb_op_comprout, (void *)&flag, (int)0);
|
|
if (result != 0) /* exit if not sent */
|
|
return -1;
|
|
|
|
while (0 == flag) /* wait for send to finish */
|
|
;
|
|
|
|
return 0;
|
|
|
|
case ADB_HW_PB:
|
|
pm_set_date_time(time);
|
|
return 0;
|
|
|
|
case ADB_HW_II:
|
|
case ADB_HW_IISI:
|
|
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; /* 2 byte message */
|
|
output[1] = 0x01; /* to pram/rtc/soft-power device */
|
|
output[2] = 0x0a; /* set date/time */
|
|
result = send_adb_IIsi((u_char *)output, (u_char *)0,
|
|
(void *)0, (void *)0, (int)0);
|
|
if (result != 0) /* exit if not sent */
|
|
return -1;
|
|
|
|
for (;;); /* wait for power off */
|
|
|
|
return 0;
|
|
|
|
case ADB_HW_PB:
|
|
pm_adb_poweroff();
|
|
|
|
for (;;); /* wait for power off */
|
|
|
|
return 0;
|
|
|
|
case ADB_HW_CUDA:
|
|
output[0] = 0x02; /* 2 byte message */
|
|
output[1] = 0x01; /* to pram/rtc/soft-power device */
|
|
output[2] = 0x0a; /* set date/time */
|
|
result = send_adb_cuda((u_char *)output, (u_char *)0,
|
|
(void *)0, (void *)0, (int)0);
|
|
if (result != 0) /* exit if not sent */
|
|
return -1;
|
|
|
|
for (;;); /* wait for power off */
|
|
|
|
return 0;
|
|
|
|
case ADB_HW_II: /* II models don't do ADB soft power */
|
|
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; /* 3 byte message */
|
|
output[1] = 0x01; /* to pram/rtc/soft-power device */
|
|
output[2] = 0x1c; /* prog. switch control */
|
|
output[3] = 0x01; /* enable */
|
|
result = send_adb_IIsi((u_char *)output, (u_char *)0,
|
|
(void *)adb_op_comprout, (void *)&flag, (int)0);
|
|
if (result != 0) /* exit if not sent */
|
|
return -1;
|
|
|
|
while (0 == flag) /* wait for send to finish */
|
|
;
|
|
|
|
return 0;
|
|
|
|
case ADB_HW_PB:
|
|
return -1;
|
|
|
|
case ADB_HW_II: /* II models don't do prog. switch */
|
|
case ADB_HW_CUDA: /* cuda doesn't do prog. switch TO DO: verify this */
|
|
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; /* 3 byte message */
|
|
output[1] = 0x01; /* to pram/rtc/soft-power device */
|
|
output[2] = 0x1c; /* prog. switch control */
|
|
output[3] = 0x01; /* disable */
|
|
result = send_adb_IIsi((u_char *)output, (u_char *)0,
|
|
(void *)adb_op_comprout, (void *)&flag, (int)0);
|
|
if (result != 0) /* exit if not sent */
|
|
return -1;
|
|
|
|
while (0 == flag) /* wait for send to finish */
|
|
;
|
|
|
|
return 0;
|
|
|
|
case ADB_HW_PB:
|
|
return -1;
|
|
|
|
case ADB_HW_II: /* II models don't do prog. switch */
|
|
case ADB_HW_CUDA: /* cuda doesn't do prog. switch */
|
|
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
|
|
|
|
int
|
|
setsoftadb()
|
|
{
|
|
callout_reset(&adb_soft_intr_ch, 1, (void *)adb_soft_intr, NULL);
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
adb_cuda_autopoll()
|
|
{
|
|
volatile int flag = 0;
|
|
int result;
|
|
u_char output[16];
|
|
|
|
output[0] = 0x03; /* 3-byte message */
|
|
output[1] = 0x01; /* to pram/rtc device */
|
|
output[2] = 0x01; /* cuda autopoll */
|
|
output[3] = 0x01;
|
|
result = send_adb_cuda(output, output, adb_op_comprout, (void *)&flag,
|
|
0);
|
|
if (result != 0) /* exit if not sent */
|
|
return;
|
|
|
|
while (flag == 0); /* wait for result */
|
|
}
|
|
|
|
void
|
|
adb_restart(void)
|
|
{
|
|
int result;
|
|
u_char output[16];
|
|
|
|
adb_polling = 1;
|
|
|
|
switch (adbHardware) {
|
|
case ADB_HW_CUDA:
|
|
output[0] = 0x02; /* 2 byte message */
|
|
output[1] = 0x01; /* to pram/rtc/soft-power device */
|
|
output[2] = 0x11; /* restart */
|
|
result = send_adb_cuda(output, NULL, NULL, NULL, 0);
|
|
if (result != 0) /* exit if not sent */
|
|
return;
|
|
while (1); /* not return */
|
|
|
|
case ADB_HW_PB:
|
|
pm_adb_restart();
|
|
while (1); /* not return */
|
|
}
|
|
}
|