[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / ieee1394 / hosts.c

/*
 * IEEE 1394 for Linux
 *
 * Low level (host adapter) management.
 *
 * Copyright (C) 1999 Andreas E. Bombe
 * Copyright (C) 1999 Emanuel Pirker
 *
 * This code is licensed under the GPL.  See the file COPYING in the root
 * directory of the kernel sources for details.
 */

#include <linux/module.h>
#include <linux/types.h>
#include <linux/list.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/timer.h>
#include <linux/jiffies.h>
#include <linux/mutex.h>

#include "csr1212.h"
#include "ieee1394.h"
#include "ieee1394_types.h"
#include "hosts.h"
#include "ieee1394_core.h"
#include "highlevel.h"
#include "nodemgr.h"
#include "csr.h"
#include "config_roms.h"


static void delayed_reset_bus(struct work_struct *work)
{
	struct hpsb_host *host =
		container_of(work, struct hpsb_host, delayed_reset.work);
	int generation = host->csr.generation + 1;

	/* The generation field rolls over to 2 rather than 0 per IEEE
	 * 1394a-2000. */
	if (generation > 0xf || generation < 2)
		generation = 2;

	CSR_SET_BUS_INFO_GENERATION(host->csr.rom, generation);
	if (csr1212_generate_csr_image(host->csr.rom) != CSR1212_SUCCESS) {
		/* CSR image creation failed.
		 * Reset generation field and do not issue a bus reset. */
		CSR_SET_BUS_INFO_GENERATION(host->csr.rom,
					    host->csr.generation);
		return;
	}

	host->csr.generation = generation;

	host->update_config_rom = 0;
	if (host->driver->set_hw_config_rom)
		host->driver->set_hw_config_rom(host,
						host->csr.rom->bus_info_data);

	host->csr.gen_timestamp[host->csr.generation] = jiffies;
	hpsb_reset_bus(host, SHORT_RESET);
}

static int dummy_transmit_packet(struct hpsb_host *h, struct hpsb_packet *p)
{
	return 0;
}

static int dummy_devctl(struct hpsb_host *h, enum devctl_cmd c, int arg)
{
	return -1;
}

static int dummy_isoctl(struct hpsb_iso *iso, enum isoctl_cmd command,
			unsigned long arg)
{
	return -1;
}

static struct hpsb_host_driver dummy_driver = {
	.transmit_packet = dummy_transmit_packet,
	.devctl =	   dummy_devctl,
	.isoctl =	   dummy_isoctl
};

static int alloc_hostnum_cb(struct hpsb_host *host, void *__data)
{
	int *hostnum = __data;

	if (host->id == *hostnum)
		return 1;

	return 0;
}

static DEFINE_MUTEX(host_num_alloc);

/**
 * hpsb_alloc_host - allocate a new host controller.
 * @drv: the driver that will manage the host controller
 * @extra: number of extra bytes to allocate for the driver
 *
 * Allocate a &hpsb_host and initialize the general subsystem specific
 * fields.  If the driver needs to store per host data, as drivers
 * usually do, the amount of memory required can be specified by the
 * @extra parameter.  Once allocated, the driver should initialize the
 * driver specific parts, enable the controller and make it available
 * to the general subsystem using hpsb_add_host().
 *
 * Return Value: a pointer to the &hpsb_host if successful, %NULL if
 * no memory was available.
 */
struct hpsb_host *hpsb_alloc_host(struct hpsb_host_driver *drv, size_t extra,
				  struct device *dev)
{
	struct hpsb_host *h;
	int i;
	int hostnum = 0;

	h = kzalloc(sizeof(*h) + extra, GFP_KERNEL);
	if (!h)
		return NULL;

	h->csr.rom = csr1212_create_csr(&csr_bus_ops, CSR_BUS_INFO_SIZE, h);
	if (!h->csr.rom)
		goto fail;

	h->hostdata = h + 1;
	h->driver = drv;

	INIT_LIST_HEAD(&h->pending_packets);
	INIT_LIST_HEAD(&h->addr_space);

	for (i = 2; i < 16; i++)
		h->csr.gen_timestamp[i] = jiffies - 60 * HZ;

	atomic_set(&h->generation, 0);

	INIT_DELAYED_WORK(&h->delayed_reset, delayed_reset_bus);
	
	init_timer(&h->timeout);
	h->timeout.data = (unsigned long) h;
	h->timeout.function = abort_timedouts;
	h->timeout_interval = HZ / 20; /* 50ms, half of minimum SPLIT_TIMEOUT */

	h->topology_map = h->csr.topology_map + 3;
	h->speed_map = (u8 *)(h->csr.speed_map + 2);

	mutex_lock(&host_num_alloc);
	while (nodemgr_for_each_host(&hostnum, alloc_hostnum_cb))
		hostnum++;
	mutex_unlock(&host_num_alloc);
	h->id = hostnum;

	memcpy(&h->device, &nodemgr_dev_template_host, sizeof(h->device));
	h->device.parent = dev;
	set_dev_node(&h->device, dev_to_node(dev));
	dev_set_name(&h->device, "fw-host%d", h->id);

	h->host_dev.parent = &h->device;
	h->host_dev.class = &hpsb_host_class;
	dev_set_name(&h->host_dev, "fw-host%d", h->id);

	if (device_register(&h->device))
		goto fail;
	if (device_register(&h->host_dev)) {
		device_unregister(&h->device);
		goto fail;
	}
	get_device(&h->device);

	return h;

fail:
	kfree(h);
	return NULL;
}

int hpsb_add_host(struct hpsb_host *host)
{
	if (hpsb_default_host_entry(host))
		return -ENOMEM;

	highlevel_add_host(host);
	return 0;
}

void hpsb_resume_host(struct hpsb_host *host)
{
	if (host->driver->set_hw_config_rom)
		host->driver->set_hw_config_rom(host,
						host->csr.rom->bus_info_data);
	host->driver->devctl(host, RESET_BUS, SHORT_RESET);
}

void hpsb_remove_host(struct hpsb_host *host)
{
	host->is_shutdown = 1;

	cancel_delayed_work(&host->delayed_reset);
	flush_scheduled_work();

	host->driver = &dummy_driver;
	highlevel_remove_host(host);

	device_unregister(&host->host_dev);
	device_unregister(&host->device);
}

/**
 * hpsb_update_config_rom_image - updates configuration ROM image of a host
 *
 * Updates the configuration ROM image of a host.  rom_version must be the
 * current version, otherwise it will fail with return value -1. If this
 * host does not support config-rom-update, it will return -%EINVAL.
 * Return value 0 indicates success.
 */
int hpsb_update_config_rom_image(struct hpsb_host *host)
{
	unsigned long reset_delay;
	int next_gen = host->csr.generation + 1;

	if (!host->update_config_rom)
		return -EINVAL;

	if (next_gen > 0xf)
		next_gen = 2;

	/* Stop the delayed interrupt, we're about to change the config rom and
	 * it would be a waste to do a bus reset twice. */
	cancel_delayed_work(&host->delayed_reset);

	/* IEEE 1394a-2000 prohibits using the same generation number
	 * twice in a 60 second period. */
	if (time_before(jiffies, host->csr.gen_timestamp[next_gen] + 60 * HZ))
		/* Wait 60 seconds from the last time this generation number was
		 * used. */
		reset_delay =
			(60 * HZ) + host->csr.gen_timestamp[next_gen] - jiffies;
	else
		/* Wait 1 second in case some other code wants to change the
		 * Config ROM in the near future. */
		reset_delay = HZ;

	PREPARE_DELAYED_WORK(&host->delayed_reset, delayed_reset_bus);
	schedule_delayed_work(&host->delayed_reset, reset_delay);

	return 0;
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* IEEE 1394 for Linux
	3	*
	4	* Low level (host adapter) management.
	5	*
	6	* Copyright (C) 1999 Andreas E. Bombe
	7	* Copyright (C) 1999 Emanuel Pirker
	8	*
	9	* This code is licensed under the GPL. See the file COPYING in the root
	10	* directory of the kernel sources for details.
	11	*/
	12
1da177e4 LT	13	#include <linux/module.h>
	14	#include <linux/types.h>
	15	#include <linux/list.h>
	16	#include <linux/init.h>
	17	#include <linux/slab.h>
1da177e4	18	#include <linux/timer.h>
63bea350	19	#include <linux/jiffies.h>
fa7614de	20	#include <linux/mutex.h>
1da177e4 LT	21
	22	#include "csr1212.h"
	23	#include "ieee1394.h"
	24	#include "ieee1394_types.h"
	25	#include "hosts.h"
	26	#include "ieee1394_core.h"
	27	#include "highlevel.h"
	28	#include "nodemgr.h"
	29	#include "csr.h"
	30	#include "config_roms.h"
	31
	32
c4028958	33	static void delayed_reset_bus(struct work_struct *work)
1da177e4	34	{
c4028958 DH	35	struct hpsb_host *host =
c4028958 DH	36	container_of(work, struct hpsb_host, delayed_reset.work);
1da177e4 LT	37	int generation = host->csr.generation + 1;
	38
	39	/* The generation field rolls over to 2 rather than 0 per IEEE
	40	* 1394a-2000. */
	41	if (generation > 0xf \|\| generation < 2)
	42	generation = 2;
	43
	44	CSR_SET_BUS_INFO_GENERATION(host->csr.rom, generation);
	45	if (csr1212_generate_csr_image(host->csr.rom) != CSR1212_SUCCESS) {
1ed891c6 SR	46	/* CSR image creation failed.
	47	* Reset generation field and do not issue a bus reset. */
	48	CSR_SET_BUS_INFO_GENERATION(host->csr.rom,
	49	host->csr.generation);
1da177e4 LT	50	return;
	51	}
	52
	53	host->csr.generation = generation;
	54
	55	host->update_config_rom = 0;
	56	if (host->driver->set_hw_config_rom)
1ed891c6 SR	57	host->driver->set_hw_config_rom(host,
1ed891c6 SR	58	host->csr.rom->bus_info_data);
1da177e4 LT	59
	60	host->csr.gen_timestamp[host->csr.generation] = jiffies;
	61	hpsb_reset_bus(host, SHORT_RESET);
	62	}
	63
	64	static int dummy_transmit_packet(struct hpsb_host h, struct hpsb_packet p)
	65	{
741854e4	66	return 0;
1da177e4 LT	67	}
	68
	69	static int dummy_devctl(struct hpsb_host *h, enum devctl_cmd c, int arg)
	70	{
741854e4	71	return -1;
1da177e4 LT	72	}
1da177e4 LT	73
1ed891c6 SR	74	static int dummy_isoctl(struct hpsb_iso *iso, enum isoctl_cmd command,
1ed891c6 SR	75	unsigned long arg)
1da177e4 LT	76	{
	77	return -1;
	78	}
	79
	80	static struct hpsb_host_driver dummy_driver = {
741854e4 SR	81	.transmit_packet = dummy_transmit_packet,
	82	.devctl = dummy_devctl,
	83	.isoctl = dummy_isoctl
1da177e4 LT	84	};
	85
	86	static int alloc_hostnum_cb(struct hpsb_host host, void __data)
	87	{
	88	int *hostnum = __data;
	89
	90	if (host->id == *hostnum)
	91	return 1;
	92
	93	return 0;
	94	}
	95
3c6c65f5 SR	96	static DEFINE_MUTEX(host_num_alloc);
3c6c65f5 SR	97
1da177e4 LT	98	/**
	99	* hpsb_alloc_host - allocate a new host controller.
	100	* @drv: the driver that will manage the host controller
	101	* @extra: number of extra bytes to allocate for the driver
	102	*
	103	* Allocate a &hpsb_host and initialize the general subsystem specific
	104	* fields. If the driver needs to store per host data, as drivers
	105	* usually do, the amount of memory required can be specified by the
	106	* @extra parameter. Once allocated, the driver should initialize the
	107	* driver specific parts, enable the controller and make it available
	108	* to the general subsystem using hpsb_add_host().
	109	*
d6e05edc	110	* Return Value: a pointer to the &hpsb_host if successful, %NULL if
1da177e4 LT	111	* no memory was available.
1da177e4 LT	112	*/
1da177e4 LT	113	struct hpsb_host hpsb_alloc_host(struct hpsb_host_driver drv, size_t extra,
	114	struct device *dev)
	115	{
741854e4	116	struct hpsb_host *h;
1da177e4 LT	117	int i;
	118	int hostnum = 0;
	119
e94b1766	120	h = kzalloc(sizeof(*h) + extra, GFP_KERNEL);
741854e4	121	if (!h)
8551158a	122	return NULL;
1da177e4 LT	123
1da177e4 LT	124	h->csr.rom = csr1212_create_csr(&csr_bus_ops, CSR_BUS_INFO_SIZE, h);
c1c9c7cd SR	125	if (!h->csr.rom)
c1c9c7cd SR	126	goto fail;
1da177e4 LT	127
1da177e4 LT	128	h->hostdata = h + 1;
741854e4	129	h->driver = drv;
1da177e4	130
7542e0e6	131	INIT_LIST_HEAD(&h->pending_packets);
1da177e4 LT	132	INIT_LIST_HEAD(&h->addr_space);
	133
	134	for (i = 2; i < 16; i++)
	135	h->csr.gen_timestamp[i] = jiffies - 60 * HZ;
	136
1da177e4 LT	137	atomic_set(&h->generation, 0);
1da177e4 LT	138
c4028958	139	INIT_DELAYED_WORK(&h->delayed_reset, delayed_reset_bus);
1da177e4 LT	140
	141	init_timer(&h->timeout);
	142	h->timeout.data = (unsigned long) h;
	143	h->timeout.function = abort_timedouts;
1ed891c6	144	h->timeout_interval = HZ / 20; /* 50ms, half of minimum SPLIT_TIMEOUT */
1da177e4	145
741854e4 SR	146	h->topology_map = h->csr.topology_map + 3;
741854e4 SR	147	h->speed_map = (u8 *)(h->csr.speed_map + 2);
1da177e4	148
fa7614de	149	mutex_lock(&host_num_alloc);
1da177e4 LT	150	while (nodemgr_for_each_host(&hostnum, alloc_hostnum_cb))
1da177e4 LT	151	hostnum++;
5c37dcbe	152	mutex_unlock(&host_num_alloc);
1da177e4 LT	153	h->id = hostnum;
	154
	155	memcpy(&h->device, &nodemgr_dev_template_host, sizeof(h->device));
	156	h->device.parent = dev;
93f2e025	157	set_dev_node(&h->device, dev_to_node(dev));
233976e5	158	dev_set_name(&h->device, "fw-host%d", h->id);
1da177e4	159
dd7f2928 KS	160	h->host_dev.parent = &h->device;
dd7f2928 KS	161	h->host_dev.class = &hpsb_host_class;
233976e5	162	dev_set_name(&h->host_dev, "fw-host%d", h->id);
1da177e4	163
c1c9c7cd SR	164	if (device_register(&h->device))
c1c9c7cd SR	165	goto fail;
dd7f2928	166	if (device_register(&h->host_dev)) {
c1c9c7cd SR	167	device_unregister(&h->device);
	168	goto fail;
	169	}
1da177e4 LT	170	get_device(&h->device);
1da177e4 LT	171
1da177e4	172	return h;
c1c9c7cd SR	173
	174	fail:
	175	kfree(h);
	176	return NULL;
1da177e4 LT	177	}
	178
	179	int hpsb_add_host(struct hpsb_host *host)
	180	{
	181	if (hpsb_default_host_entry(host))
	182	return -ENOMEM;
70093cfd	183
1da177e4	184	highlevel_add_host(host);
1da177e4 LT	185	return 0;
	186	}
	187
3360177c SR	188	void hpsb_resume_host(struct hpsb_host *host)
	189	{
	190	if (host->driver->set_hw_config_rom)
	191	host->driver->set_hw_config_rom(host,
	192	host->csr.rom->bus_info_data);
	193	host->driver->devctl(host, RESET_BUS, SHORT_RESET);
	194	}
	195
1da177e4 LT	196	void hpsb_remove_host(struct hpsb_host *host)
1da177e4 LT	197	{
741854e4	198	host->is_shutdown = 1;
1da177e4 LT	199
	200	cancel_delayed_work(&host->delayed_reset);
	201	flush_scheduled_work();
	202
741854e4	203	host->driver = &dummy_driver;
741854e4	204	highlevel_remove_host(host);
1da177e4	205
dd7f2928	206	device_unregister(&host->host_dev);
1da177e4 LT	207	device_unregister(&host->device);
	208	}
	209
afd6546d SR	210	/**
	211	* hpsb_update_config_rom_image - updates configuration ROM image of a host
	212	*
	213	* Updates the configuration ROM image of a host. rom_version must be the
	214	* current version, otherwise it will fail with return value -1. If this
	215	* host does not support config-rom-update, it will return -%EINVAL.
	216	* Return value 0 indicates success.
	217	*/
1da177e4 LT	218	int hpsb_update_config_rom_image(struct hpsb_host *host)
	219	{
	220	unsigned long reset_delay;
	221	int next_gen = host->csr.generation + 1;
	222
	223	if (!host->update_config_rom)
	224	return -EINVAL;
	225
	226	if (next_gen > 0xf)
	227	next_gen = 2;
	228
	229	/* Stop the delayed interrupt, we're about to change the config rom and
	230	* it would be a waste to do a bus reset twice. */
	231	cancel_delayed_work(&host->delayed_reset);
	232
	233	/* IEEE 1394a-2000 prohibits using the same generation number
	234	* twice in a 60 second period. */
63bea350	235	if (time_before(jiffies, host->csr.gen_timestamp[next_gen] + 60 * HZ))
1da177e4 LT	236	/* Wait 60 seconds from the last time this generation number was
1da177e4 LT	237	* used. */
1ed891c6 SR	238	reset_delay =
1ed891c6 SR	239	(60 * HZ) + host->csr.gen_timestamp[next_gen] - jiffies;
1da177e4 LT	240	else
	241	/* Wait 1 second in case some other code wants to change the
	242	* Config ROM in the near future. */
	243	reset_delay = HZ;
	244
c4028958	245	PREPARE_DELAYED_WORK(&host->delayed_reset, delayed_reset_bus);
1da177e4 LT	246	schedule_delayed_work(&host->delayed_reset, reset_delay);
	247
	248	return 0;
	249	}