Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 0fe85d50 authored by David S. Miller's avatar David S. Miller
Browse files

[SPARC64]: Convert parport to of_platform_driver. 



Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 3adf55ad

include/asm-sparc64/parport.h

+133 −100
Original line number Diff line number Diff line
@@ -8,8 +8,9 @@ 
#define _ASM_SPARC64_PARPORT_H 1



#include <asm/ebus.h>

#include <asm/isa.h>

#include <asm/ns87303.h>

#include <asm/of_device.h>

#include <asm/prom.h>



#define PARPORT_PC_MAX_PORTS	PARPORT_MAX
@@ -35,8 +36,12 @@ static struct sparc_ebus_info { 
	unsigned int addr;

	unsigned int count;

	int lock;



	struct parport *port;

} sparc_ebus_dmas[PARPORT_PC_MAX_PORTS];



static DECLARE_BITMAP(dma_slot_map, PARPORT_PC_MAX_PORTS);



static __inline__ int request_dma(unsigned int dmanr, const char *device_id)

{

	if (dmanr >= PARPORT_PC_MAX_PORTS)
@@ -98,90 +103,53 @@ static __inline__ unsigned int get_dma_residue(unsigned int dmanr) 
	return ebus_dma_residue(&sparc_ebus_dmas[dmanr].info);

}



static int ebus_ecpp_p(struct linux_ebus_device *edev)

static int __devinit ecpp_probe(struct of_device *op, const struct of_device_id *match)

{

	if (!strcmp(edev->prom_node->name, "ecpp"))

		return 1;

	if (!strcmp(edev->prom_node->name, "parallel")) {

		const char *compat;



		compat = of_get_property(edev->prom_node,

					 "compatible", NULL);

		if (compat &&

		    (!strcmp(compat, "ecpp") ||

		     !strcmp(compat, "ns87317-ecpp") ||

		     !strcmp(compat + 13, "ecpp")))

			return 1;

	}

	unsigned long base = op->resource[0].start;

	unsigned long config = op->resource[1].start;

	unsigned long d_base = op->resource[2].start;

	unsigned long d_len;

	struct device_node *parent;

	struct parport *p;

	int slot, err;



	parent = op->node->parent;

	if (!strcmp(parent->name, "dma")) {

		p = parport_pc_probe_port(base, base + 0x400,

					  op->irqs[0], PARPORT_DMA_NOFIFO,

					  op->dev.parent);

		if (!p)

			return -ENOMEM;

		dev_set_drvdata(&op->dev, p);

		return 0;

	}



static int parport_isa_probe(int count)

{

	struct sparc_isa_bridge *isa_br;

	struct sparc_isa_device *isa_dev;



	for_each_isa(isa_br) {

		for_each_isadev(isa_dev, isa_br) {

			struct sparc_isa_device *child;

			unsigned long base;



			if (strcmp(isa_dev->prom_node->name, "dma"))

				continue;



			child = isa_dev->child;

			while (child) {

				if (!strcmp(child->prom_node->name, "parallel"))

	for (slot = 0; slot < PARPORT_PC_MAX_PORTS; slot++) {

		if (!test_and_set_bit(slot, dma_slot_map))

			break;

				child = child->next;

	}

			if (!child)

				continue;

	err = -ENODEV;

	if (slot >= PARPORT_PC_MAX_PORTS)

		goto out_err;



			base = child->resource.start;

	spin_lock_init(&sparc_ebus_dmas[slot].info.lock);



			/* No DMA, see commentary in

			 * asm-sparc64/floppy.h:isa_floppy_init()

			 */

			if (parport_pc_probe_port(base, base + 0x400,

						  child->irq, PARPORT_DMA_NOFIFO,

						  &child->bus->self->dev))

				count++;

		}

	}

	d_len = (op->resource[2].end - d_base) + 1UL;

	sparc_ebus_dmas[slot].info.regs =

		of_ioremap(&op->resource[2], 0, d_len, "ECPP DMA");



	return count;

}

	if (!sparc_ebus_dmas[slot].info.regs)

		goto out_clear_map;



static int parport_pc_find_nonpci_ports (int autoirq, int autodma)

{

	struct linux_ebus *ebus;

	struct linux_ebus_device *edev;

	int count = 0;



	for_each_ebus(ebus) {

		for_each_ebusdev(edev, ebus) {

			if (ebus_ecpp_p(edev)) {

				unsigned long base = edev->resource[0].start;

				unsigned long config = edev->resource[1].start;

				unsigned long d_base = edev->resource[2].start;

				unsigned long d_len;

	sparc_ebus_dmas[slot].info.flags = 0;

	sparc_ebus_dmas[slot].info.callback = NULL;

	sparc_ebus_dmas[slot].info.client_cookie = NULL;

	sparc_ebus_dmas[slot].info.irq = 0xdeadbeef;

	strcpy(sparc_ebus_dmas[slot].info.name, "parport");

	if (ebus_dma_register(&sparc_ebus_dmas[slot].info))

		goto out_unmap_regs;



				spin_lock_init(&sparc_ebus_dmas[count].info.lock);

				d_len = (edev->resource[2].end -

					 d_base) + 1;

				sparc_ebus_dmas[count].info.regs =

					ioremap(d_base, d_len);

				if (!sparc_ebus_dmas[count].info.regs)

					continue;

				sparc_ebus_dmas[count].info.flags = 0;

				sparc_ebus_dmas[count].info.callback = NULL;

				sparc_ebus_dmas[count].info.client_cookie = NULL;

				sparc_ebus_dmas[count].info.irq = 0xdeadbeef;

				strcpy(sparc_ebus_dmas[count].info.name, "parport");

				if (ebus_dma_register(&sparc_ebus_dmas[count].info))

					continue;

				ebus_dma_irq_enable(&sparc_ebus_dmas[count].info, 1);

	ebus_dma_irq_enable(&sparc_ebus_dmas[slot].info, 1);



	/* Configure IRQ to Push Pull, Level Low */

	/* Enable ECP, set bit 2 of the CTR first */
@@ -197,18 +165,83 @@ static int parport_pc_find_nonpci_ports (int autoirq, int autodma) 
	ns87303_modify(config, PTR,

		       0, PTR_LPT_REG_DIR);



				if (parport_pc_probe_port(base, base + 0x400,

							  edev->irqs[0],

							  count,

							  &ebus->self->dev))

					count++;

	p = parport_pc_probe_port(base, base + 0x400,

				  op->irqs[0],

				  slot,

				  op->dev.parent);

	err = -ENOMEM;

	if (!p)

		goto out_disable_irq;



	dev_set_drvdata(&op->dev, p);



	return 0;



out_disable_irq:

	ebus_dma_irq_enable(&sparc_ebus_dmas[slot].info, 0);

	ebus_dma_unregister(&sparc_ebus_dmas[slot].info);



out_unmap_regs:

	of_iounmap(&op->resource[2], sparc_ebus_dmas[slot].info.regs, d_len);



out_clear_map:

	clear_bit(slot, dma_slot_map);



out_err:

	return err;

}



static int __devexit ecpp_remove(struct of_device *op)

{

	struct parport *p = dev_get_drvdata(&op->dev);

	int slot = p->dma;



	parport_pc_unregister_port(p);



	if (slot != PARPORT_DMA_NOFIFO) {

		unsigned long d_base = op->resource[2].start;

		unsigned long d_len;



		d_len = (op->resource[2].end - d_base) + 1UL;



		ebus_dma_irq_enable(&sparc_ebus_dmas[slot].info, 0);

		ebus_dma_unregister(&sparc_ebus_dmas[slot].info);

		of_iounmap(&op->resource[2],

			   sparc_ebus_dmas[slot].info.regs,

			   d_len);

		clear_bit(slot, dma_slot_map);

	}



	return 0;

}



	count = parport_isa_probe(count);

static struct of_device_id ecpp_match[] = {

	{

		.name = "ecpp",

	},

	{

		.name = "parallel",

		.compatible = "ecpp",

	},

	{

		.name = "parallel",

		.compatible = "ns87317-ecpp",

	},

	{},

};



static struct of_platform_driver ecpp_driver = {

	.name			= "ecpp",

	.match_table		= ecpp_match,

	.probe			= ecpp_probe,

	.remove			= __devexit_p(ecpp_remove),

};



	return count;

static int parport_pc_find_nonpci_ports(int autoirq, int autodma)

{

	of_register_driver(&ecpp_driver, &of_bus_type);



	return 0;

}



#endif /* !(_ASM_SPARC64_PARPORT_H */