Openwrt/target/linux/s3c24xx/files-2.6.31/drivers/ar6000/hif/hif2.c

/*
 * hif2.c - HIF layer re-implementation for the Linux SDIO stack
 *
 * Copyright (C) 2008, 2009 by OpenMoko, Inc.
 * Written by Werner Almesberger <werner@openmoko.org>
 * All Rights Reserved
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation;
 *
 * Based on:
 *
 * @abstract: HIF layer reference implementation for Atheros SDIO stack
 * @notice: Copyright (c) 2004-2006 Atheros Communications Inc.
 */


#include <linux/kernel.h>
#include <linux/kthread.h>
#include <linux/list.h>
#include <linux/wait.h>
#include <linux/spinlock.h>
#include <linux/mutex.h>
#include <linux/sched.h>
#include <linux/mmc/sdio_func.h>
#include <linux/mmc/sdio.h>
#include <linux/mmc/sdio_ids.h>

#include "athdefs.h"
#include "a_types.h"
#include "hif.h"


/* @@@ Hack - this wants cleaning up */

#ifdef CONFIG_MACH_NEO1973_GTA02

#include <mach/gta02-pm-wlan.h>

#else /* CONFIG_MACH_NEO1973_GTA02 */

#define	gta02_wlan_query_rfkill_lock()  1
#define	gta02_wlan_set_rfkill_cb(cb, hif) ((void) cb)
#define	gta02_wlan_query_rfkill_unlock()
#define	gta02_wlan_clear_rfkill_cb()

#endif /* !CONFIG_MACH_NEO1973_GTA02 */


/*
 * KNOWN BUGS:
 *
 * - HIF_DEVICE_IRQ_ASYNC_SYNC doesn't work yet (gets MMC errors)
 * - latency can reach hundreds of ms, probably because of scheduling delays
 * - packets go through about three queues before finally hitting the network
 */

/*
 * Differences from Atheros' HIFs:
 *
 * - synchronous and asynchronous requests may get reordered with respect to
 *   each other, e.g., if HIFReadWrite returns for an asynchronous request and
 *   then HIFReadWrite is called for a synchronous request, the synchronous
 *   request may be executed before the asynchronous request.
 *
 * - request queue locking seems unnecessarily complex in the Atheros HIFs.
 *
 * - Atheros mask interrupts by calling sdio_claim_irq/sdio_release_irq, which
 *   can cause quite a bit of overhead. This HIF has its own light-weight
 *   interrupt masking.
 *
 * - Atheros call deviceInsertedHandler from a thread spawned off the probe or
 *   device insertion function. The original explanation for the Atheros SDIO
 *   stack said that this is done because a delay is needed to let the chip
 *   complete initialization. There is indeed a one second delay in the thread.
 *
 *   The Atheros Linux SDIO HIF removes the delay and only retains the thread.
 *   Experimentally removing the thread didn't show any conflicts, so let's get
 *   rid of it for good.
 *
 * - The Atheros SDIO stack with Samuel's driver sets SDIO_CCCR_POWER in
 *   SDIO_POWER_EMPC. Atheros' Linux SDIO code apparently doesn't. We don't
 *   either, and this seems to work fine.
 *   @@@ Need to check this with Atheros.
 */


#define MBOXES			4

#define HIF_MBOX_BLOCK_SIZE	128
#define	HIF_MBOX_BASE_ADDR	0x800
#define	HIF_MBOX_WIDTH		0x800
#define	HIF_MBOX_START_ADDR(mbox) \
    (HIF_MBOX_BASE_ADDR+(mbox)*HIF_MBOX_WIDTH)


struct hif_device {
	void *htc_handle;
	struct sdio_func *func;

	/*
	 * @@@ our sweet little bit of bogosity - the mechanism that lets us
	 * use the SDIO stack from softirqs. This really wants to use skbs.
	 */
	struct list_head queue;
	spinlock_t queue_lock;
	struct task_struct *io_task;
	wait_queue_head_t wait;

	/*
	 * activate_lock protects "active" and the activation/deactivation
	 * process itself.
	 *
	 * Relation to other locks: The SDIO function can be claimed while
	 * activate_lock is being held, but trying to acquire activate_lock
	 * while having ownership of the SDIO function could cause a deadlock.
	 */
	int active;
	struct mutex activate_lock;
};

struct hif_request {
	struct list_head list;
	struct sdio_func *func;
	int (*read)(struct sdio_func *func,
	    void *dst, unsigned int addr, int count);
	int (*write)(struct sdio_func *func,
	    unsigned int addr, void *src, int count);
	void *buf;
	unsigned long addr;
	int len;
	A_STATUS (*completion)(void *context, A_STATUS status);
	void *context;
};


static HTC_CALLBACKS htcCallbacks;

/*
 * shutdown_lock prevents recursion through HIFShutDownDevice
 */
static DEFINE_MUTEX(shutdown_lock);


/* ----- Request processing ------------------------------------------------ */


static A_STATUS process_request(struct hif_request *req)
{
	int ret;
	A_STATUS status;

	dev_dbg(&req->func->dev, "process_request(req %p)\n", req);
	sdio_claim_host(req->func);
	if (req->read) {
		ret = req->read(req->func, req->buf, req->addr, req->len);
	} else {
		ret = req->write(req->func, req->addr, req->buf, req->len);
	}
	sdio_release_host(req->func);
	status = ret ? A_ERROR : A_OK;
	if (req->completion)
		req->completion(req->context, status);
	kfree(req);
	return status;
}


static void enqueue_request(struct hif_device *hif, struct hif_request *req)
{
	unsigned long flags;

	dev_dbg(&req->func->dev, "enqueue_request(req %p)\n", req);
	spin_lock_irqsave(&hif->queue_lock, flags);
	list_add_tail(&req->list, &hif->queue);
	spin_unlock_irqrestore(&hif->queue_lock, flags);
	wake_up(&hif->wait);
}


static struct hif_request *dequeue_request(struct hif_device *hif)
{
	struct hif_request *req;
	unsigned long flags;

	spin_lock_irqsave(&hif->queue_lock, flags);
	if (list_empty(&hif->queue))
		req = NULL;
	else {
		req = list_first_entry(&hif->queue,
		    struct hif_request, list);
		list_del(&req->list);
	}
	spin_unlock_irqrestore(&hif->queue_lock, flags);
	return req;
}


static void wait_queue_empty(struct hif_device *hif)
{
	unsigned long flags;
	int empty;

	while (1) {
		spin_lock_irqsave(&hif->queue_lock, flags);
		empty = list_empty(&hif->queue);
		spin_unlock_irqrestore(&hif->queue_lock, flags);
		if (empty)
			break;
		else
			yield();
	}
}


static int io(void *data)
{
	struct hif_device *hif = data;
	struct sched_param param = { .sched_priority = 2 };
		/* one priority level slower than ksdioirqd (which is at 1) */
	DEFINE_WAIT(wait);
	struct hif_request *req;

	sched_setscheduler(current, SCHED_FIFO, &param);

	while (1) {
		while (1) {
			/*
			 * Since we never use signals here, one might think
			 * that this ought to be TASK_UNINTERRUPTIBLE. However,
			 * such a task would increase the load average and,
			 * worse, it would trigger the softlockup check.
			 */
			prepare_to_wait(&hif->wait, &wait, TASK_INTERRUPTIBLE);
			if (kthread_should_stop()) {
				finish_wait(&hif->wait, &wait);
				return 0;
			}
			req = dequeue_request(hif);
			if (req)
				break;
			schedule();
		}
		finish_wait(&hif->wait, &wait);

		(void) process_request(req);
	}
	return 0;
}


A_STATUS HIFReadWrite(HIF_DEVICE *hif, A_UINT32 address, A_UCHAR *buffer,
    A_UINT32 length, A_UINT32 request, void *context)
{
	struct device *dev = HIFGetOSDevice(hif);
	struct hif_request *req;

	dev_dbg(dev, "HIFReadWrite(device %p, address 0x%x, buffer %p, "
	    "length %d, request 0x%x, context %p)\n",
	    hif, address, buffer, length, request, context);

	BUG_ON(!(request & (HIF_SYNCHRONOUS | HIF_ASYNCHRONOUS)));
	BUG_ON(!(request & (HIF_BYTE_BASIS | HIF_BLOCK_BASIS)));
	BUG_ON(!(request & (HIF_READ | HIF_WRITE)));
	BUG_ON(!(request & HIF_EXTENDED_IO));

	if (address >= HIF_MBOX_START_ADDR(0) &&
	    address < HIF_MBOX_START_ADDR(MBOXES+1)) {
		BUG_ON(length > HIF_MBOX_WIDTH);
		/* Adjust the address so that the last byte falls on the EOM
		   address. */
		address += HIF_MBOX_WIDTH-length;
	}

	req = kzalloc(sizeof(*req), GFP_ATOMIC);
	if (!req) {
		if (request & HIF_ASYNCHRONOUS)
			htcCallbacks.rwCompletionHandler(context, A_ERROR);
		return A_ERROR;
	}

	req->func = hif->func;
	req->addr = address;
	req->buf = buffer;
	req->len = length;

	if (request & HIF_READ) {
		if (request & HIF_FIXED_ADDRESS)
			req->read = sdio_readsb;
		else
			req->read = sdio_memcpy_fromio;
	} else {
		if (request & HIF_FIXED_ADDRESS)
			req->write = sdio_writesb;
		else
			req->write = sdio_memcpy_toio;
	}

	if (!(request & HIF_ASYNCHRONOUS))
		return process_request(req);

	req->completion = htcCallbacks.rwCompletionHandler;
	req->context = context;
	enqueue_request(hif, req);

	return A_OK;
}


/* ----- Interrupt handling ------------------------------------------------ */

/*
 * Volatile ought to be good enough to make gcc do the right thing on S3C24xx.
 * No need to use atomic or put barriers, keeping the code more readable.
 *
 * Warning: this story changes if going SMP/SMT.
 */

static volatile int masked = 1;
static volatile int pending;
static volatile int in_interrupt;


static void ar6000_do_irq(struct sdio_func *func)
{
	HIF_DEVICE *hif = sdio_get_drvdata(func);
	struct device *dev = HIFGetOSDevice(hif);
	A_STATUS status;

	dev_dbg(dev, "ar6000_do_irq -> %p\n", htcCallbacks.dsrHandler);

	status = htcCallbacks.dsrHandler(hif->htc_handle);
	BUG_ON(status != A_OK);
}


static void sdio_ar6000_irq(struct sdio_func *func)
{
	HIF_DEVICE *hif = sdio_get_drvdata(func);
	struct device *dev = HIFGetOSDevice(hif);

	dev_dbg(dev, "sdio_ar6000_irq\n");

	in_interrupt = 1;
	if (masked) {
		in_interrupt = 0;
		pending++;
		return;
	}
	/*
	 * @@@ This is ugly. If we don't drop the lock, we'll deadlock when
	 * the handler tries to do SDIO. So there are four choices:
	 *
	 * 1) Break the call chain by calling the callback from a workqueue.
	 *    Ugh.
	 * 2) Make process_request aware that we already have the lock.
	 * 3) Drop the lock. Which is ugly but should be safe as long as we're
	 *    making sure the device doesn't go away.
	 * 4) Change the AR6k driver such that it only issues asynchronous
	 *    quests when called from an interrupt.
	 *
	 * Solution 2) is probably the best for now. Will try it later.
	 */
	sdio_release_host(func);
	ar6000_do_irq(func);
	sdio_claim_host(func);
	in_interrupt = 0;
}


void HIFAckInterrupt(HIF_DEVICE *hif)
{
	struct device *dev = HIFGetOSDevice(hif);

	dev_dbg(dev, "HIFAckInterrupt\n");
	/* do nothing */
}


void HIFUnMaskInterrupt(HIF_DEVICE *hif)
{
	struct device *dev = HIFGetOSDevice(hif);

	dev_dbg(dev, "HIFUnMaskInterrupt\n");
	do {
		masked = 1;
		if (pending) {
			pending = 0;
			ar6000_do_irq(hif->func);
			/* We may take an interrupt before unmasking and thus
			   get it pending. In this case, we just loop back. */
		}
		masked = 0;
	}
	while (pending);
}


void HIFMaskInterrupt(HIF_DEVICE *hif)
{
	struct device *dev = HIFGetOSDevice(hif);

	dev_dbg(dev, "HIFMaskInterrupt\n");
	/*
	 * Since sdio_ar6000_irq can also be called from a process context, we
	 * may conceivably end up racing with it. Thus, we need to wait until
	 * we can be sure that no concurrent interrupt processing is going on
	 * before we return.
	 *
	 * Note: this may be a bit on the paranoid side - the callers may
	 * actually be nice enough to disable scheduling. Check later.
	 */
	masked = 1;
	while (in_interrupt)
		yield();
}


/* ----- HIF API glue functions -------------------------------------------- */


struct device *HIFGetOSDevice(HIF_DEVICE *hif)
{
	return &hif->func->dev;
}


void HIFSetHandle(void *hif_handle, void *handle)
{
	HIF_DEVICE *hif = (HIF_DEVICE *) hif_handle;

	hif->htc_handle = handle;
}


/* ----- Device configuration (HIF side) ----------------------------------- */


A_STATUS HIFConfigureDevice(HIF_DEVICE *hif,
    HIF_DEVICE_CONFIG_OPCODE opcode, void *config, A_UINT32 configLen)
{
	struct device *dev = HIFGetOSDevice(hif);
	HIF_DEVICE_IRQ_PROCESSING_MODE *ipm_cfg = config;
	A_UINT32 *mbs_cfg = config;
	int i;

	dev_dbg(dev, "HIFConfigureDevice\n");

	switch (opcode) {
	case HIF_DEVICE_GET_MBOX_BLOCK_SIZE:
		for (i = 0; i != MBOXES; i++)
			mbs_cfg[i] = HIF_MBOX_BLOCK_SIZE;
		break;
	case HIF_DEVICE_GET_MBOX_ADDR:
		for (i = 0; i != MBOXES; i++)
			mbs_cfg[i] = HIF_MBOX_START_ADDR(i);
		break;
	case HIF_DEVICE_GET_IRQ_PROC_MODE:
		*ipm_cfg = HIF_DEVICE_IRQ_SYNC_ONLY;
//		*ipm_cfg = HIF_DEVICE_IRQ_ASYNC_SYNC;
		break;
	default:
		return A_ERROR;
	}
	return A_OK;
}


/* ----- Device probe and removal (Linux side) ----------------------------- */


static int ar6000_do_activate(struct hif_device *hif)
{
	struct sdio_func *func = hif->func;
	struct device *dev = &func->dev;
	int ret;

	dev_dbg(dev, "ar6000_do_activate\n");

	sdio_claim_host(func);
	sdio_enable_func(func);

	INIT_LIST_HEAD(&hif->queue);
	init_waitqueue_head(&hif->wait);
	spin_lock_init(&hif->queue_lock);

	ret = sdio_set_block_size(func, HIF_MBOX_BLOCK_SIZE);
	if (ret < 0) {
		dev_err(dev, "sdio_set_block_size returns %d\n", ret);
		goto out_enabled;
	}
	ret = sdio_claim_irq(func, sdio_ar6000_irq);
	if (ret) {
		dev_err(dev, "sdio_claim_irq returns %d\n", ret);
		goto out_enabled;
	}
	/* Set SDIO_BUS_CD_DISABLE in SDIO_CCCR_IF ? */
#if 0
	sdio_f0_writeb(func, SDIO_CCCR_CAP_E4MI, SDIO_CCCR_CAPS, &ret);
	if (ret) {
		dev_err(dev, "sdio_f0_writeb(SDIO_CCCR_CAPS) returns %d\n",
		    ret);
		goto out_got_irq;
	}
#else
	if (0) /* avoid warning */
		goto out_got_irq;
#endif

	sdio_release_host(func);

	hif->io_task = kthread_run(io, hif, "ar6000_io");
	ret = IS_ERR(hif->io_task);
	if (ret) {
		dev_err(dev, "kthread_run(ar6000_io): %d\n", ret);
		goto out_func_ready;
	}

	ret = htcCallbacks.deviceInsertedHandler(hif);
	if (ret == A_OK)
		return 0;

	dev_err(dev, "deviceInsertedHandler: %d\n", ret);

	ret = kthread_stop(hif->io_task);
	if (ret)
		dev_err(dev, "kthread_stop (ar6000_io): %d\n", ret);

out_func_ready:
	sdio_claim_host(func);

out_got_irq:
	sdio_release_irq(func);

out_enabled:
	sdio_disable_func(func);
	sdio_release_host(func);

	return ret;
}


static void ar6000_do_deactivate(struct hif_device *hif)
{
	struct sdio_func *func = hif->func;
	struct device *dev = &func->dev;
	int ret;

	dev_dbg(dev, "ar6000_do_deactivate\n");
	if (!hif->active)
		return;

	if (mutex_trylock(&shutdown_lock)) {
		/*
		 * Funny, Atheros' HIF does this call, but this just puts us in
		 * a recursion through HTCShutDown/HIFShutDown if unloading the
		 * module.
		 *
		 * However, we need it for suspend/resume. See the comment at
		 * HIFShutDown, below.
		 */
		ret = htcCallbacks.deviceRemovedHandler(hif->htc_handle, A_OK);
		if (ret != A_OK)
			dev_err(dev, "deviceRemovedHandler: %d\n", ret);
		mutex_unlock(&shutdown_lock);
	}
	wait_queue_empty(hif);
	ret = kthread_stop(hif->io_task);
	if (ret)
		dev_err(dev, "kthread_stop (ar6000_io): %d\n", ret);
	sdio_claim_host(func);
	sdio_release_irq(func);
	sdio_disable_func(func);
	sdio_release_host(func);
}


static int ar6000_activate(struct hif_device *hif)
{
	int ret = 0;

	dev_dbg(&hif->func->dev, "ar6000_activate\n");
	mutex_lock(&hif->activate_lock);
	if (!hif->active) {
		ret = ar6000_do_activate(hif);
		if (ret) {
			printk(KERN_ERR "%s: Failed to activate %d\n",
				__func__, ret);
			goto out;
		}
		hif->active = 1;
	}
out:
	mutex_unlock(&hif->activate_lock);
	return ret;
}


static void ar6000_deactivate(struct hif_device *hif)
{
	dev_dbg(&hif->func->dev, "ar6000_deactivate\n");
	mutex_lock(&hif->activate_lock);
	if (hif->active) {
		ar6000_do_deactivate(hif);
		hif->active = 0;
	}
	mutex_unlock(&hif->activate_lock);
}


static int ar6000_rfkill_cb(void *data, int on)
{
	struct hif_device *hif = data;
	struct sdio_func *func = hif->func;
	struct device *dev = &func->dev;

	dev_dbg(dev, "ar6000_rfkill_cb: on %d\n", on);
	if (on)
		return ar6000_activate(hif);
	ar6000_deactivate(hif);
	return 0;
}


static int sdio_ar6000_probe(struct sdio_func *func,
    const struct sdio_device_id *id)
{
	struct device *dev = &func->dev;
	struct hif_device *hif;
	int ret = 0;

	dev_dbg(dev, "sdio_ar6000_probe\n");
	BUG_ON(!htcCallbacks.deviceInsertedHandler);

	hif = kzalloc(sizeof(*hif), GFP_KERNEL);
	if (!hif)
		return -ENOMEM;

	sdio_set_drvdata(func, hif);
	hif->func = func;
	mutex_init(&hif->activate_lock);
	hif->active = 0;

	if (gta02_wlan_query_rfkill_lock())
		ret = ar6000_activate(hif);
	if (!ret) {
		gta02_wlan_set_rfkill_cb(ar6000_rfkill_cb, hif);
		return 0;
	}
	gta02_wlan_query_rfkill_unlock();
	sdio_set_drvdata(func, NULL);
	kfree(hif);
	return ret;
}


static void sdio_ar6000_remove(struct sdio_func *func)
{
	struct device *dev = &func->dev;
	HIF_DEVICE *hif = sdio_get_drvdata(func);

	dev_dbg(dev, "sdio_ar6000_remove\n");
	gta02_wlan_clear_rfkill_cb();
	ar6000_deactivate(hif);
	sdio_set_drvdata(func, NULL);
	kfree(hif);
}


/* ----- Device registration/unregistration (called by HIF) ---------------- */


#define ATHEROS_SDIO_DEVICE(id, offset) \
    SDIO_DEVICE(SDIO_VENDOR_ID_ATHEROS, SDIO_DEVICE_ID_ATHEROS_##id | (offset))

static const struct sdio_device_id sdio_ar6000_ids[] = {
	{ ATHEROS_SDIO_DEVICE(AR6002, 0)	},
	{ ATHEROS_SDIO_DEVICE(AR6002, 0x1)	},
	{ ATHEROS_SDIO_DEVICE(AR6001, 0x8)	},
	{ ATHEROS_SDIO_DEVICE(AR6001, 0x9)	},
	{ ATHEROS_SDIO_DEVICE(AR6001, 0xa)	},
	{ ATHEROS_SDIO_DEVICE(AR6001, 0xb)	},
	{ /* end: all zeroes */			},
};

MODULE_DEVICE_TABLE(sdio, sdio_ar6000_ids);


static struct sdio_driver sdio_ar6000_driver = {
	.probe		= sdio_ar6000_probe,
	.remove		= sdio_ar6000_remove,
	.name		= "sdio_ar6000",
	.id_table	= sdio_ar6000_ids,
};


int HIFInit(HTC_CALLBACKS *callbacks)
{
	int ret;

	BUG_ON(!callbacks);

	printk(KERN_DEBUG "HIFInit\n");
	htcCallbacks = *callbacks;

	ret = sdio_register_driver(&sdio_ar6000_driver);
	if (ret) {
		printk(KERN_ERR
		    "sdio_register_driver(sdio_ar6000_driver): %d\n", ret);
		return A_ERROR;
	}

	return 0;
}


/*
 * We have four possible call chains here:
 *
 * System shutdown/reboot:
 *
 *   kernel_restart_prepare ...> device_shutdown ... > s3cmci_shutdown ->
 *     mmc_remove_host ..> sdio_bus_remove -> sdio_ar6000_remove ->
 *     ar6000_deactivate -> ar6000_do_deactivate ->
 *     deviceRemovedHandler (HTCTargetRemovedHandler) -> HIFShutDownDevice
 *
 *   This is roughly the same sequence as suspend, described below.
 *
 * Module removal:
 *
 *   sys_delete_module -> ar6000_cleanup_module -> HTCShutDown ->
 *     HIFShutDownDevice -> sdio_unregister_driver ...> sdio_bus_remove ->
 *     sdio_ar6000_remove -> ar6000_deactivate -> ar6000_do_deactivate
 *
 *   In this case, HIFShutDownDevice must call sdio_unregister_driver to
 *   notify the driver about its removal. ar6000_do_deactivate must not call
 *   deviceRemovedHandler, because that would loop back into HIFShutDownDevice.
 *
 * Suspend:
 *
 *   device_suspend ...> s3cmci_suspend ...> sdio_bus_remove ->
 *     sdio_ar6000_remove -> ar6000_deactivate -> ar6000_do_deactivate ->
 *     deviceRemovedHandler (HTCTargetRemovedHandler) -> HIFShutDownDevice
 *
 *   We must call deviceRemovedHandler to inform the ar6k stack that the device
 *   has been removed. Since HTCTargetRemovedHandler calls back into
 *   HIFShutDownDevice, we must also prevent the call to
 *   sdio_unregister_driver, or we'd end up recursing into the SDIO stack,
 *   eventually deadlocking somewhere.
 *
 * rfkill:
 *
 *   rfkill_state_store -> rfkill_toggle_radio -> gta02_wlan_toggle_radio ->
 *   ar6000_rfkill_cb -> ar6000_deactivate -> ar6000_do_deactivate ->
 *     deviceRemovedHandler (HTCTargetRemovedHandler) -> HIFShutDownDevice
 *
 *   This is similar to suspend - only the entry point changes.
 */

void HIFShutDownDevice(HIF_DEVICE *hif)
{
	/* Beware, HTCShutDown calls us with hif == NULL ! */
	if (mutex_trylock(&shutdown_lock)) {
		sdio_unregister_driver(&sdio_ar6000_driver);
		mutex_unlock(&shutdown_lock);
	}
}