162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * I/O Processor (IOP) ADB Driver
462306a36Sopenharmony_ci * Written and (C) 1999 by Joshua M. Thompson (funaho@jurai.org)
562306a36Sopenharmony_ci * Based on via-cuda.c by Paul Mackerras.
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci * 1999-07-01 (jmt) - First implementation for new driver architecture.
862306a36Sopenharmony_ci *
962306a36Sopenharmony_ci * 1999-07-31 (jmt) - First working version.
1062306a36Sopenharmony_ci */
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_ci#include <linux/types.h>
1362306a36Sopenharmony_ci#include <linux/kernel.h>
1462306a36Sopenharmony_ci#include <linux/mm.h>
1562306a36Sopenharmony_ci#include <linux/delay.h>
1662306a36Sopenharmony_ci#include <linux/init.h>
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ci#include <asm/macintosh.h>
1962306a36Sopenharmony_ci#include <asm/macints.h>
2062306a36Sopenharmony_ci#include <asm/mac_iop.h>
2162306a36Sopenharmony_ci#include <asm/adb_iop.h>
2262306a36Sopenharmony_ci#include <asm/unaligned.h>
2362306a36Sopenharmony_ci
2462306a36Sopenharmony_ci#include <linux/adb.h>
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_cistatic struct adb_request *current_req;
2762306a36Sopenharmony_cistatic struct adb_request *last_req;
2862306a36Sopenharmony_cistatic unsigned int autopoll_devs;
2962306a36Sopenharmony_cistatic u8 autopoll_addr;
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_cistatic enum adb_iop_state {
3262306a36Sopenharmony_ci	idle,
3362306a36Sopenharmony_ci	sending,
3462306a36Sopenharmony_ci	awaiting_reply
3562306a36Sopenharmony_ci} adb_iop_state;
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_cistatic void adb_iop_start(void);
3862306a36Sopenharmony_cistatic int adb_iop_probe(void);
3962306a36Sopenharmony_cistatic int adb_iop_init(void);
4062306a36Sopenharmony_cistatic int adb_iop_send_request(struct adb_request *, int);
4162306a36Sopenharmony_cistatic int adb_iop_write(struct adb_request *);
4262306a36Sopenharmony_cistatic int adb_iop_autopoll(int);
4362306a36Sopenharmony_cistatic void adb_iop_poll(void);
4462306a36Sopenharmony_cistatic int adb_iop_reset_bus(void);
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_ci/* ADB command byte structure */
4762306a36Sopenharmony_ci#define ADDR_MASK       0xF0
4862306a36Sopenharmony_ci#define OP_MASK         0x0C
4962306a36Sopenharmony_ci#define TALK            0x0C
5062306a36Sopenharmony_ci
5162306a36Sopenharmony_cistruct adb_driver adb_iop_driver = {
5262306a36Sopenharmony_ci	.name         = "ISM IOP",
5362306a36Sopenharmony_ci	.probe        = adb_iop_probe,
5462306a36Sopenharmony_ci	.init         = adb_iop_init,
5562306a36Sopenharmony_ci	.send_request = adb_iop_send_request,
5662306a36Sopenharmony_ci	.autopoll     = adb_iop_autopoll,
5762306a36Sopenharmony_ci	.poll         = adb_iop_poll,
5862306a36Sopenharmony_ci	.reset_bus    = adb_iop_reset_bus
5962306a36Sopenharmony_ci};
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_cistatic void adb_iop_done(void)
6262306a36Sopenharmony_ci{
6362306a36Sopenharmony_ci	struct adb_request *req = current_req;
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_ci	adb_iop_state = idle;
6662306a36Sopenharmony_ci
6762306a36Sopenharmony_ci	req->complete = 1;
6862306a36Sopenharmony_ci	current_req = req->next;
6962306a36Sopenharmony_ci	if (req->done)
7062306a36Sopenharmony_ci		(*req->done)(req);
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_ci	if (adb_iop_state == idle)
7362306a36Sopenharmony_ci		adb_iop_start();
7462306a36Sopenharmony_ci}
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_ci/*
7762306a36Sopenharmony_ci * Completion routine for ADB commands sent to the IOP.
7862306a36Sopenharmony_ci *
7962306a36Sopenharmony_ci * This will be called when a packet has been successfully sent.
8062306a36Sopenharmony_ci */
8162306a36Sopenharmony_ci
8262306a36Sopenharmony_cistatic void adb_iop_complete(struct iop_msg *msg)
8362306a36Sopenharmony_ci{
8462306a36Sopenharmony_ci	unsigned long flags;
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_ci	local_irq_save(flags);
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_ci	adb_iop_state = awaiting_reply;
8962306a36Sopenharmony_ci
9062306a36Sopenharmony_ci	local_irq_restore(flags);
9162306a36Sopenharmony_ci}
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_ci/*
9462306a36Sopenharmony_ci * Listen for ADB messages from the IOP.
9562306a36Sopenharmony_ci *
9662306a36Sopenharmony_ci * This will be called when unsolicited IOP messages are received.
9762306a36Sopenharmony_ci * These IOP messages can carry ADB autopoll responses and also occur
9862306a36Sopenharmony_ci * after explicit ADB commands.
9962306a36Sopenharmony_ci */
10062306a36Sopenharmony_ci
10162306a36Sopenharmony_cistatic void adb_iop_listen(struct iop_msg *msg)
10262306a36Sopenharmony_ci{
10362306a36Sopenharmony_ci	struct adb_iopmsg *amsg = (struct adb_iopmsg *)msg->message;
10462306a36Sopenharmony_ci	u8 addr = (amsg->cmd & ADDR_MASK) >> 4;
10562306a36Sopenharmony_ci	u8 op = amsg->cmd & OP_MASK;
10662306a36Sopenharmony_ci	unsigned long flags;
10762306a36Sopenharmony_ci	bool req_done = false;
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	local_irq_save(flags);
11062306a36Sopenharmony_ci
11162306a36Sopenharmony_ci	/* Responses to Talk commands may be unsolicited as they are
11262306a36Sopenharmony_ci	 * produced when the IOP polls devices. They are mostly timeouts.
11362306a36Sopenharmony_ci	 */
11462306a36Sopenharmony_ci	if (op == TALK && ((1 << addr) & autopoll_devs))
11562306a36Sopenharmony_ci		autopoll_addr = addr;
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_ci	switch (amsg->flags & (ADB_IOP_EXPLICIT |
11862306a36Sopenharmony_ci			       ADB_IOP_AUTOPOLL |
11962306a36Sopenharmony_ci			       ADB_IOP_TIMEOUT)) {
12062306a36Sopenharmony_ci	case ADB_IOP_EXPLICIT:
12162306a36Sopenharmony_ci	case ADB_IOP_EXPLICIT | ADB_IOP_TIMEOUT:
12262306a36Sopenharmony_ci		if (adb_iop_state == awaiting_reply) {
12362306a36Sopenharmony_ci			struct adb_request *req = current_req;
12462306a36Sopenharmony_ci
12562306a36Sopenharmony_ci			if (req->reply_expected) {
12662306a36Sopenharmony_ci				req->reply_len = amsg->count + 1;
12762306a36Sopenharmony_ci				memcpy(req->reply, &amsg->cmd, req->reply_len);
12862306a36Sopenharmony_ci			}
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_ci			req_done = true;
13162306a36Sopenharmony_ci		}
13262306a36Sopenharmony_ci		break;
13362306a36Sopenharmony_ci	case ADB_IOP_AUTOPOLL:
13462306a36Sopenharmony_ci		if (((1 << addr) & autopoll_devs) &&
13562306a36Sopenharmony_ci		    amsg->cmd == ADB_READREG(addr, 0))
13662306a36Sopenharmony_ci			adb_input(&amsg->cmd, amsg->count + 1, 1);
13762306a36Sopenharmony_ci		break;
13862306a36Sopenharmony_ci	}
13962306a36Sopenharmony_ci	msg->reply[0] = autopoll_addr ? ADB_IOP_AUTOPOLL : 0;
14062306a36Sopenharmony_ci	msg->reply[1] = 0;
14162306a36Sopenharmony_ci	msg->reply[2] = autopoll_addr ? ADB_READREG(autopoll_addr, 0) : 0;
14262306a36Sopenharmony_ci	iop_complete_message(msg);
14362306a36Sopenharmony_ci
14462306a36Sopenharmony_ci	if (req_done)
14562306a36Sopenharmony_ci		adb_iop_done();
14662306a36Sopenharmony_ci
14762306a36Sopenharmony_ci	local_irq_restore(flags);
14862306a36Sopenharmony_ci}
14962306a36Sopenharmony_ci
15062306a36Sopenharmony_ci/*
15162306a36Sopenharmony_ci * Start sending an ADB packet, IOP style
15262306a36Sopenharmony_ci *
15362306a36Sopenharmony_ci * There isn't much to do other than hand the packet over to the IOP
15462306a36Sopenharmony_ci * after encapsulating it in an adb_iopmsg.
15562306a36Sopenharmony_ci */
15662306a36Sopenharmony_ci
15762306a36Sopenharmony_cistatic void adb_iop_start(void)
15862306a36Sopenharmony_ci{
15962306a36Sopenharmony_ci	struct adb_request *req;
16062306a36Sopenharmony_ci	struct adb_iopmsg amsg;
16162306a36Sopenharmony_ci
16262306a36Sopenharmony_ci	/* get the packet to send */
16362306a36Sopenharmony_ci	req = current_req;
16462306a36Sopenharmony_ci	if (!req)
16562306a36Sopenharmony_ci		return;
16662306a36Sopenharmony_ci
16762306a36Sopenharmony_ci	/* The IOP takes MacII-style packets, so strip the initial
16862306a36Sopenharmony_ci	 * ADB_PACKET byte.
16962306a36Sopenharmony_ci	 */
17062306a36Sopenharmony_ci	amsg.flags = ADB_IOP_EXPLICIT;
17162306a36Sopenharmony_ci	amsg.count = req->nbytes - 2;
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_ci	/* amsg.data immediately follows amsg.cmd, effectively making
17462306a36Sopenharmony_ci	 * &amsg.cmd a pointer to the beginning of a full ADB packet.
17562306a36Sopenharmony_ci	 */
17662306a36Sopenharmony_ci	memcpy(&amsg.cmd, req->data + 1, req->nbytes - 1);
17762306a36Sopenharmony_ci
17862306a36Sopenharmony_ci	req->sent = 1;
17962306a36Sopenharmony_ci	adb_iop_state = sending;
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_ci	/* Now send it. The IOP manager will call adb_iop_complete
18262306a36Sopenharmony_ci	 * when the message has been sent.
18362306a36Sopenharmony_ci	 */
18462306a36Sopenharmony_ci	iop_send_message(ADB_IOP, ADB_CHAN, req, sizeof(amsg), (__u8 *)&amsg,
18562306a36Sopenharmony_ci			 adb_iop_complete);
18662306a36Sopenharmony_ci}
18762306a36Sopenharmony_ci
18862306a36Sopenharmony_cistatic int adb_iop_probe(void)
18962306a36Sopenharmony_ci{
19062306a36Sopenharmony_ci	if (!iop_ism_present)
19162306a36Sopenharmony_ci		return -ENODEV;
19262306a36Sopenharmony_ci	return 0;
19362306a36Sopenharmony_ci}
19462306a36Sopenharmony_ci
19562306a36Sopenharmony_cistatic int adb_iop_init(void)
19662306a36Sopenharmony_ci{
19762306a36Sopenharmony_ci	pr_info("adb: IOP ISM driver v0.4 for Unified ADB\n");
19862306a36Sopenharmony_ci	iop_listen(ADB_IOP, ADB_CHAN, adb_iop_listen, "ADB");
19962306a36Sopenharmony_ci	return 0;
20062306a36Sopenharmony_ci}
20162306a36Sopenharmony_ci
20262306a36Sopenharmony_cistatic int adb_iop_send_request(struct adb_request *req, int sync)
20362306a36Sopenharmony_ci{
20462306a36Sopenharmony_ci	int err;
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_ci	err = adb_iop_write(req);
20762306a36Sopenharmony_ci	if (err)
20862306a36Sopenharmony_ci		return err;
20962306a36Sopenharmony_ci
21062306a36Sopenharmony_ci	if (sync) {
21162306a36Sopenharmony_ci		while (!req->complete)
21262306a36Sopenharmony_ci			adb_iop_poll();
21362306a36Sopenharmony_ci	}
21462306a36Sopenharmony_ci	return 0;
21562306a36Sopenharmony_ci}
21662306a36Sopenharmony_ci
21762306a36Sopenharmony_cistatic int adb_iop_write(struct adb_request *req)
21862306a36Sopenharmony_ci{
21962306a36Sopenharmony_ci	unsigned long flags;
22062306a36Sopenharmony_ci
22162306a36Sopenharmony_ci	if ((req->nbytes < 2) || (req->data[0] != ADB_PACKET)) {
22262306a36Sopenharmony_ci		req->complete = 1;
22362306a36Sopenharmony_ci		return -EINVAL;
22462306a36Sopenharmony_ci	}
22562306a36Sopenharmony_ci
22662306a36Sopenharmony_ci	req->next = NULL;
22762306a36Sopenharmony_ci	req->sent = 0;
22862306a36Sopenharmony_ci	req->complete = 0;
22962306a36Sopenharmony_ci	req->reply_len = 0;
23062306a36Sopenharmony_ci
23162306a36Sopenharmony_ci	local_irq_save(flags);
23262306a36Sopenharmony_ci
23362306a36Sopenharmony_ci	if (current_req) {
23462306a36Sopenharmony_ci		last_req->next = req;
23562306a36Sopenharmony_ci		last_req = req;
23662306a36Sopenharmony_ci	} else {
23762306a36Sopenharmony_ci		current_req = req;
23862306a36Sopenharmony_ci		last_req = req;
23962306a36Sopenharmony_ci	}
24062306a36Sopenharmony_ci
24162306a36Sopenharmony_ci	if (adb_iop_state == idle)
24262306a36Sopenharmony_ci		adb_iop_start();
24362306a36Sopenharmony_ci
24462306a36Sopenharmony_ci	local_irq_restore(flags);
24562306a36Sopenharmony_ci
24662306a36Sopenharmony_ci	return 0;
24762306a36Sopenharmony_ci}
24862306a36Sopenharmony_ci
24962306a36Sopenharmony_cistatic void adb_iop_set_ap_complete(struct iop_msg *msg)
25062306a36Sopenharmony_ci{
25162306a36Sopenharmony_ci	struct adb_iopmsg *amsg = (struct adb_iopmsg *)msg->message;
25262306a36Sopenharmony_ci
25362306a36Sopenharmony_ci	autopoll_devs = get_unaligned_be16(amsg->data);
25462306a36Sopenharmony_ci	if (autopoll_devs & (1 << autopoll_addr))
25562306a36Sopenharmony_ci		return;
25662306a36Sopenharmony_ci	autopoll_addr = autopoll_devs ? (ffs(autopoll_devs) - 1) : 0;
25762306a36Sopenharmony_ci}
25862306a36Sopenharmony_ci
25962306a36Sopenharmony_cistatic int adb_iop_autopoll(int devs)
26062306a36Sopenharmony_ci{
26162306a36Sopenharmony_ci	struct adb_iopmsg amsg;
26262306a36Sopenharmony_ci	unsigned long flags;
26362306a36Sopenharmony_ci	unsigned int mask = (unsigned int)devs & 0xFFFE;
26462306a36Sopenharmony_ci
26562306a36Sopenharmony_ci	local_irq_save(flags);
26662306a36Sopenharmony_ci
26762306a36Sopenharmony_ci	amsg.flags = ADB_IOP_SET_AUTOPOLL | (mask ? ADB_IOP_AUTOPOLL : 0);
26862306a36Sopenharmony_ci	amsg.count = 2;
26962306a36Sopenharmony_ci	amsg.cmd = 0;
27062306a36Sopenharmony_ci	put_unaligned_be16(mask, amsg.data);
27162306a36Sopenharmony_ci
27262306a36Sopenharmony_ci	iop_send_message(ADB_IOP, ADB_CHAN, NULL, sizeof(amsg), (__u8 *)&amsg,
27362306a36Sopenharmony_ci			 adb_iop_set_ap_complete);
27462306a36Sopenharmony_ci
27562306a36Sopenharmony_ci	local_irq_restore(flags);
27662306a36Sopenharmony_ci
27762306a36Sopenharmony_ci	return 0;
27862306a36Sopenharmony_ci}
27962306a36Sopenharmony_ci
28062306a36Sopenharmony_cistatic void adb_iop_poll(void)
28162306a36Sopenharmony_ci{
28262306a36Sopenharmony_ci	iop_ism_irq_poll(ADB_IOP);
28362306a36Sopenharmony_ci}
28462306a36Sopenharmony_ci
28562306a36Sopenharmony_cistatic int adb_iop_reset_bus(void)
28662306a36Sopenharmony_ci{
28762306a36Sopenharmony_ci	struct adb_request req;
28862306a36Sopenharmony_ci
28962306a36Sopenharmony_ci	/* Command = 0, Address = ignored */
29062306a36Sopenharmony_ci	adb_request(&req, NULL, ADBREQ_NOSEND, 1, ADB_BUSRESET);
29162306a36Sopenharmony_ci	adb_iop_send_request(&req, 1);
29262306a36Sopenharmony_ci
29362306a36Sopenharmony_ci	/* Don't want any more requests during the Global Reset low time. */
29462306a36Sopenharmony_ci	mdelay(3);
29562306a36Sopenharmony_ci
29662306a36Sopenharmony_ci	return 0;
29762306a36Sopenharmony_ci}
298