macintosh/via-macii, macintosh/adb-iop: Clean up whitespace
Signed-off-by: Finn Thain <fthain@telegraphics.com.au> Signed-off-by: Michael Ellerman <mpe@ellerman.id.au>
This commit is contained in:
parent
351e5ad327
commit
47fd206066
|
@ -38,9 +38,9 @@ static unsigned char *reply_ptr;
|
|||
#endif
|
||||
|
||||
static enum adb_iop_state {
|
||||
idle,
|
||||
sending,
|
||||
awaiting_reply
|
||||
idle,
|
||||
sending,
|
||||
awaiting_reply
|
||||
} adb_iop_state;
|
||||
|
||||
static void adb_iop_start(void);
|
||||
|
@ -66,7 +66,8 @@ static void adb_iop_end_req(struct adb_request *req, int state)
|
|||
{
|
||||
req->complete = 1;
|
||||
current_req = req->next;
|
||||
if (req->done) (*req->done)(req);
|
||||
if (req->done)
|
||||
(*req->done)(req);
|
||||
adb_iop_state = state;
|
||||
}
|
||||
|
||||
|
@ -100,7 +101,7 @@ static void adb_iop_complete(struct iop_msg *msg)
|
|||
|
||||
static void adb_iop_listen(struct iop_msg *msg)
|
||||
{
|
||||
struct adb_iopmsg *amsg = (struct adb_iopmsg *) msg->message;
|
||||
struct adb_iopmsg *amsg = (struct adb_iopmsg *)msg->message;
|
||||
struct adb_request *req;
|
||||
unsigned long flags;
|
||||
#ifdef DEBUG_ADB_IOP
|
||||
|
@ -113,9 +114,9 @@ static void adb_iop_listen(struct iop_msg *msg)
|
|||
|
||||
#ifdef DEBUG_ADB_IOP
|
||||
printk("adb_iop_listen %p: rcvd packet, %d bytes: %02X %02X", req,
|
||||
(uint) amsg->count + 2, (uint) amsg->flags, (uint) amsg->cmd);
|
||||
(uint)amsg->count + 2, (uint)amsg->flags, (uint)amsg->cmd);
|
||||
for (i = 0; i < amsg->count; i++)
|
||||
printk(" %02X", (uint) amsg->data[i]);
|
||||
printk(" %02X", (uint)amsg->data[i]);
|
||||
printk("\n");
|
||||
#endif
|
||||
|
||||
|
@ -168,14 +169,15 @@ static void adb_iop_start(void)
|
|||
|
||||
/* get the packet to send */
|
||||
req = current_req;
|
||||
if (!req) return;
|
||||
if (!req)
|
||||
return;
|
||||
|
||||
local_irq_save(flags);
|
||||
|
||||
#ifdef DEBUG_ADB_IOP
|
||||
printk("adb_iop_start %p: sending packet, %d bytes:", req, req->nbytes);
|
||||
for (i = 0 ; i < req->nbytes ; i++)
|
||||
printk(" %02X", (uint) req->data[i]);
|
||||
for (i = 0; i < req->nbytes; i++)
|
||||
printk(" %02X", (uint)req->data[i]);
|
||||
printk("\n");
|
||||
#endif
|
||||
|
||||
|
@ -196,13 +198,14 @@ static void adb_iop_start(void)
|
|||
/* Now send it. The IOP manager will call adb_iop_complete */
|
||||
/* when the packet has been sent. */
|
||||
|
||||
iop_send_message(ADB_IOP, ADB_CHAN, req,
|
||||
sizeof(amsg), (__u8 *) &amsg, adb_iop_complete);
|
||||
iop_send_message(ADB_IOP, ADB_CHAN, req, sizeof(amsg), (__u8 *)&amsg,
|
||||
adb_iop_complete);
|
||||
}
|
||||
|
||||
int adb_iop_probe(void)
|
||||
{
|
||||
if (!iop_ism_present) return -ENODEV;
|
||||
if (!iop_ism_present)
|
||||
return -ENODEV;
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
@ -218,10 +221,12 @@ int adb_iop_send_request(struct adb_request *req, int sync)
|
|||
int err;
|
||||
|
||||
err = adb_iop_write(req);
|
||||
if (err) return err;
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
if (sync) {
|
||||
while (!req->complete) adb_iop_poll();
|
||||
while (!req->complete)
|
||||
adb_iop_poll();
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
@ -251,7 +256,9 @@ static int adb_iop_write(struct adb_request *req)
|
|||
}
|
||||
|
||||
local_irq_restore(flags);
|
||||
if (adb_iop_state == idle) adb_iop_start();
|
||||
|
||||
if (adb_iop_state == idle)
|
||||
adb_iop_start();
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
@ -263,7 +270,8 @@ int adb_iop_autopoll(int devs)
|
|||
|
||||
void adb_iop_poll(void)
|
||||
{
|
||||
if (adb_iop_state == idle) adb_iop_start();
|
||||
if (adb_iop_state == idle)
|
||||
adb_iop_start();
|
||||
iop_ism_irq_poll(ADB_IOP);
|
||||
}
|
||||
|
||||
|
|
|
@ -12,7 +12,7 @@
|
|||
*
|
||||
* 1999-08-02 (jmt) - Initial rewrite for Unified ADB.
|
||||
* 2000-03-29 Tony Mantler <tonym@mac.linux-m68k.org>
|
||||
* - Big overhaul, should actually work now.
|
||||
* - Big overhaul, should actually work now.
|
||||
* 2006-12-31 Finn Thain - Another overhaul.
|
||||
*
|
||||
* Suggested reading:
|
||||
|
@ -77,7 +77,7 @@ static volatile unsigned char *via;
|
|||
#define ST_ODD 0x20 /* ADB state: odd data byte */
|
||||
#define ST_IDLE 0x30 /* ADB state: idle, nothing to send */
|
||||
|
||||
static int macii_init_via(void);
|
||||
static int macii_init_via(void);
|
||||
static void macii_start(void);
|
||||
static irqreturn_t macii_interrupt(int irq, void *arg);
|
||||
static void macii_queue_poll(void);
|
||||
|
@ -123,7 +123,8 @@ static int autopoll_devs; /* bits set are device addresses to be polled */
|
|||
/* Check for MacII style ADB */
|
||||
static int macii_probe(void)
|
||||
{
|
||||
if (macintosh_config->adb_type != MAC_ADB_II) return -ENODEV;
|
||||
if (macintosh_config->adb_type != MAC_ADB_II)
|
||||
return -ENODEV;
|
||||
|
||||
via = via1;
|
||||
|
||||
|
@ -140,11 +141,13 @@ int macii_init(void)
|
|||
local_irq_save(flags);
|
||||
|
||||
err = macii_init_via();
|
||||
if (err) goto out;
|
||||
if (err)
|
||||
goto out;
|
||||
|
||||
err = request_irq(IRQ_MAC_ADB, macii_interrupt, 0, "ADB",
|
||||
macii_interrupt);
|
||||
if (err) goto out;
|
||||
if (err)
|
||||
goto out;
|
||||
|
||||
macii_state = idle;
|
||||
out:
|
||||
|
@ -162,7 +165,7 @@ static int macii_init_via(void)
|
|||
|
||||
/* Set up state: idle */
|
||||
via[B] |= ST_IDLE;
|
||||
last_status = via[B] & (ST_MASK|CTLR_IRQ);
|
||||
last_status = via[B] & (ST_MASK | CTLR_IRQ);
|
||||
|
||||
/* Shift register on input */
|
||||
via[ACR] = (via[ACR] & ~SR_CTRL) | SR_EXT;
|
||||
|
@ -188,7 +191,8 @@ static void macii_queue_poll(void)
|
|||
int next_device;
|
||||
static struct adb_request req;
|
||||
|
||||
if (!autopoll_devs) return;
|
||||
if (!autopoll_devs)
|
||||
return;
|
||||
|
||||
device_mask = (1 << (((command_byte & 0xF0) >> 4) + 1)) - 1;
|
||||
if (autopoll_devs & ~device_mask)
|
||||
|
@ -196,8 +200,7 @@ static void macii_queue_poll(void)
|
|||
else
|
||||
next_device = ffs(autopoll_devs) - 1;
|
||||
|
||||
adb_request(&req, NULL, ADBREQ_NOSEND, 1,
|
||||
ADB_READREG(next_device, 0));
|
||||
adb_request(&req, NULL, ADBREQ_NOSEND, 1, ADB_READREG(next_device, 0));
|
||||
|
||||
req.sent = 0;
|
||||
req.complete = 0;
|
||||
|
@ -251,7 +254,8 @@ static int macii_write(struct adb_request *req)
|
|||
} else {
|
||||
current_req = req;
|
||||
last_req = req;
|
||||
if (macii_state == idle) macii_start();
|
||||
if (macii_state == idle)
|
||||
macii_start();
|
||||
}
|
||||
|
||||
local_irq_restore(flags);
|
||||
|
@ -269,7 +273,8 @@ static int macii_autopoll(int devs)
|
|||
/* bit 1 == device 1, and so on. */
|
||||
autopoll_devs = devs & 0xFFFE;
|
||||
|
||||
if (!autopoll_devs) return 0;
|
||||
if (!autopoll_devs)
|
||||
return 0;
|
||||
|
||||
local_irq_save(flags);
|
||||
|
||||
|
@ -286,7 +291,8 @@ static int macii_autopoll(int devs)
|
|||
return err;
|
||||
}
|
||||
|
||||
static inline int need_autopoll(void) {
|
||||
static inline int need_autopoll(void)
|
||||
{
|
||||
/* Was the last command Talk Reg 0
|
||||
* and is the target on the autopoll list?
|
||||
*/
|
||||
|
@ -377,147 +383,147 @@ static irqreturn_t macii_interrupt(int irq, void *arg)
|
|||
}
|
||||
|
||||
last_status = status;
|
||||
status = via[B] & (ST_MASK|CTLR_IRQ);
|
||||
status = via[B] & (ST_MASK | CTLR_IRQ);
|
||||
|
||||
switch (macii_state) {
|
||||
case idle:
|
||||
if (reading_reply) {
|
||||
reply_ptr = current_req->reply;
|
||||
} else {
|
||||
WARN_ON(current_req);
|
||||
reply_ptr = reply_buf;
|
||||
}
|
||||
case idle:
|
||||
if (reading_reply) {
|
||||
reply_ptr = current_req->reply;
|
||||
} else {
|
||||
WARN_ON(current_req);
|
||||
reply_ptr = reply_buf;
|
||||
}
|
||||
|
||||
x = via[SR];
|
||||
x = via[SR];
|
||||
|
||||
if ((status & CTLR_IRQ) && (x == 0xFF)) {
|
||||
/* Bus timeout without SRQ sequence:
|
||||
* data is "FF" while CTLR_IRQ is "H"
|
||||
*/
|
||||
reply_len = 0;
|
||||
srq_asserted = 0;
|
||||
macii_state = read_done;
|
||||
} else {
|
||||
macii_state = reading;
|
||||
*reply_ptr = x;
|
||||
reply_len = 1;
|
||||
}
|
||||
|
||||
/* set ADB state = even for first data byte */
|
||||
via[B] = (via[B] & ~ST_MASK) | ST_EVEN;
|
||||
break;
|
||||
|
||||
case sending:
|
||||
req = current_req;
|
||||
if (data_index >= req->nbytes) {
|
||||
req->sent = 1;
|
||||
macii_state = idle;
|
||||
|
||||
if (req->reply_expected) {
|
||||
reading_reply = 1;
|
||||
} else {
|
||||
req->complete = 1;
|
||||
current_req = req->next;
|
||||
if (req->done) (*req->done)(req);
|
||||
|
||||
if (current_req)
|
||||
macii_start();
|
||||
else
|
||||
if (need_autopoll())
|
||||
macii_autopoll(autopoll_devs);
|
||||
}
|
||||
|
||||
if (macii_state == idle) {
|
||||
/* reset to shift in */
|
||||
via[ACR] &= ~SR_OUT;
|
||||
x = via[SR];
|
||||
/* set ADB state idle - might get SRQ */
|
||||
via[B] = (via[B] & ~ST_MASK) | ST_IDLE;
|
||||
}
|
||||
} else {
|
||||
via[SR] = req->data[data_index++];
|
||||
|
||||
if ( (via[B] & ST_MASK) == ST_CMD ) {
|
||||
/* just sent the command byte, set to EVEN */
|
||||
via[B] = (via[B] & ~ST_MASK) | ST_EVEN;
|
||||
} else {
|
||||
/* invert state bits, toggle ODD/EVEN */
|
||||
via[B] ^= ST_MASK;
|
||||
}
|
||||
}
|
||||
break;
|
||||
|
||||
case reading:
|
||||
x = via[SR];
|
||||
WARN_ON((status & ST_MASK) == ST_CMD ||
|
||||
(status & ST_MASK) == ST_IDLE);
|
||||
|
||||
/* Bus timeout with SRQ sequence:
|
||||
* data is "XX FF" while CTLR_IRQ is "L L"
|
||||
* End of packet without SRQ sequence:
|
||||
* data is "XX...YY 00" while CTLR_IRQ is "L...H L"
|
||||
* End of packet SRQ sequence:
|
||||
* data is "XX...YY 00" while CTLR_IRQ is "L...L L"
|
||||
* (where XX is the first response byte and
|
||||
* YY is the last byte of valid response data.)
|
||||
if ((status & CTLR_IRQ) && (x == 0xFF)) {
|
||||
/* Bus timeout without SRQ sequence:
|
||||
* data is "FF" while CTLR_IRQ is "H"
|
||||
*/
|
||||
|
||||
reply_len = 0;
|
||||
srq_asserted = 0;
|
||||
if (!(status & CTLR_IRQ)) {
|
||||
if (x == 0xFF) {
|
||||
if (!(last_status & CTLR_IRQ)) {
|
||||
macii_state = read_done;
|
||||
reply_len = 0;
|
||||
srq_asserted = 1;
|
||||
}
|
||||
} else if (x == 0x00) {
|
||||
macii_state = read_done;
|
||||
if (!(last_status & CTLR_IRQ))
|
||||
srq_asserted = 1;
|
||||
}
|
||||
}
|
||||
macii_state = read_done;
|
||||
} else {
|
||||
macii_state = reading;
|
||||
*reply_ptr = x;
|
||||
reply_len = 1;
|
||||
}
|
||||
|
||||
if (macii_state == reading &&
|
||||
reply_len < ARRAY_SIZE(reply_buf)) {
|
||||
reply_ptr++;
|
||||
*reply_ptr = x;
|
||||
reply_len++;
|
||||
}
|
||||
|
||||
/* invert state bits, toggle ODD/EVEN */
|
||||
via[B] ^= ST_MASK;
|
||||
break;
|
||||
|
||||
case read_done:
|
||||
x = via[SR];
|
||||
|
||||
if (reading_reply) {
|
||||
reading_reply = 0;
|
||||
req = current_req;
|
||||
req->reply_len = reply_len;
|
||||
req->complete = 1;
|
||||
current_req = req->next;
|
||||
if (req->done) (*req->done)(req);
|
||||
} else if (reply_len && autopoll_devs)
|
||||
adb_input(reply_buf, reply_len, 0);
|
||||
/* set ADB state = even for first data byte */
|
||||
via[B] = (via[B] & ~ST_MASK) | ST_EVEN;
|
||||
break;
|
||||
|
||||
case sending:
|
||||
req = current_req;
|
||||
if (data_index >= req->nbytes) {
|
||||
req->sent = 1;
|
||||
macii_state = idle;
|
||||
|
||||
/* SRQ seen before, initiate poll now */
|
||||
if (srq_asserted)
|
||||
macii_queue_poll();
|
||||
if (req->reply_expected) {
|
||||
reading_reply = 1;
|
||||
} else {
|
||||
req->complete = 1;
|
||||
current_req = req->next;
|
||||
if (req->done)
|
||||
(*req->done)(req);
|
||||
|
||||
if (current_req)
|
||||
macii_start();
|
||||
else
|
||||
if (need_autopoll())
|
||||
if (current_req)
|
||||
macii_start();
|
||||
else if (need_autopoll())
|
||||
macii_autopoll(autopoll_devs);
|
||||
}
|
||||
|
||||
if (macii_state == idle)
|
||||
if (macii_state == idle) {
|
||||
/* reset to shift in */
|
||||
via[ACR] &= ~SR_OUT;
|
||||
x = via[SR];
|
||||
/* set ADB state idle - might get SRQ */
|
||||
via[B] = (via[B] & ~ST_MASK) | ST_IDLE;
|
||||
break;
|
||||
}
|
||||
} else {
|
||||
via[SR] = req->data[data_index++];
|
||||
|
||||
default:
|
||||
if ((via[B] & ST_MASK) == ST_CMD) {
|
||||
/* just sent the command byte, set to EVEN */
|
||||
via[B] = (via[B] & ~ST_MASK) | ST_EVEN;
|
||||
} else {
|
||||
/* invert state bits, toggle ODD/EVEN */
|
||||
via[B] ^= ST_MASK;
|
||||
}
|
||||
}
|
||||
break;
|
||||
|
||||
case reading:
|
||||
x = via[SR];
|
||||
WARN_ON((status & ST_MASK) == ST_CMD ||
|
||||
(status & ST_MASK) == ST_IDLE);
|
||||
|
||||
/* Bus timeout with SRQ sequence:
|
||||
* data is "XX FF" while CTLR_IRQ is "L L"
|
||||
* End of packet without SRQ sequence:
|
||||
* data is "XX...YY 00" while CTLR_IRQ is "L...H L"
|
||||
* End of packet SRQ sequence:
|
||||
* data is "XX...YY 00" while CTLR_IRQ is "L...L L"
|
||||
* (where XX is the first response byte and
|
||||
* YY is the last byte of valid response data.)
|
||||
*/
|
||||
|
||||
srq_asserted = 0;
|
||||
if (!(status & CTLR_IRQ)) {
|
||||
if (x == 0xFF) {
|
||||
if (!(last_status & CTLR_IRQ)) {
|
||||
macii_state = read_done;
|
||||
reply_len = 0;
|
||||
srq_asserted = 1;
|
||||
}
|
||||
} else if (x == 0x00) {
|
||||
macii_state = read_done;
|
||||
if (!(last_status & CTLR_IRQ))
|
||||
srq_asserted = 1;
|
||||
}
|
||||
}
|
||||
|
||||
if (macii_state == reading &&
|
||||
reply_len < ARRAY_SIZE(reply_buf)) {
|
||||
reply_ptr++;
|
||||
*reply_ptr = x;
|
||||
reply_len++;
|
||||
}
|
||||
|
||||
/* invert state bits, toggle ODD/EVEN */
|
||||
via[B] ^= ST_MASK;
|
||||
break;
|
||||
|
||||
case read_done:
|
||||
x = via[SR];
|
||||
|
||||
if (reading_reply) {
|
||||
reading_reply = 0;
|
||||
req = current_req;
|
||||
req->reply_len = reply_len;
|
||||
req->complete = 1;
|
||||
current_req = req->next;
|
||||
if (req->done)
|
||||
(*req->done)(req);
|
||||
} else if (reply_len && autopoll_devs)
|
||||
adb_input(reply_buf, reply_len, 0);
|
||||
|
||||
macii_state = idle;
|
||||
|
||||
/* SRQ seen before, initiate poll now */
|
||||
if (srq_asserted)
|
||||
macii_queue_poll();
|
||||
|
||||
if (current_req)
|
||||
macii_start();
|
||||
else if (need_autopoll())
|
||||
macii_autopoll(autopoll_devs);
|
||||
|
||||
if (macii_state == idle)
|
||||
via[B] = (via[B] & ~ST_MASK) | ST_IDLE;
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in New Issue