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

Commit e27af7ed authored by Marek Vasut's avatar Marek Vasut Committed by Eric Miao
Browse files

ARM: pxa: Use gpio arrays in vpac270_pcmcia driver 



Use gpio_request_array() / gpio_free_array(), this makes the code
cleaner and less error prone.

Signed-off-by: default avatarMarek Vasut <marek.vasut@gmail.com>
parent 235a175c

drivers/pcmcia/pxa2xx_vpac270.c

+29 −78
Original line number Diff line number Diff line
@@ -22,6 +22,19 @@ 


#include "soc_common.h"



static struct gpio vpac270_pcmcia_gpios[] = {

	{ GPIO84_VPAC270_PCMCIA_CD,	GPIOF_IN,	"PCMCIA Card Detect" },

	{ GPIO35_VPAC270_PCMCIA_RDY,	GPIOF_IN,	"PCMCIA Ready" },

	{ GPIO107_VPAC270_PCMCIA_PPEN,	GPIOF_INIT_LOW,	"PCMCIA PPEN" },

	{ GPIO11_VPAC270_PCMCIA_RESET,	GPIOF_INIT_LOW,	"PCMCIA Reset" },

};



static struct gpio vpac270_cf_gpios[] = {

	{ GPIO17_VPAC270_CF_CD,		GPIOF_IN,	"CF Card Detect" },

	{ GPIO12_VPAC270_CF_RDY,	GPIOF_IN,	"CF Ready" },

	{ GPIO16_VPAC270_CF_RESET,	GPIOF_INIT_LOW,	"CF Reset" },

};



static struct pcmcia_irqs cd_irqs[] = {

	{

		.sock = 0,
@@ -40,96 +53,34 @@ static int vpac270_pcmcia_hw_init(struct soc_pcmcia_socket *skt) 
	int ret;



	if (skt->nr == 0) {

		ret = gpio_request(GPIO84_VPAC270_PCMCIA_CD, "PCMCIA CD");

		if (ret)

			goto err1;

		ret = gpio_direction_input(GPIO84_VPAC270_PCMCIA_CD);

		if (ret)

			goto err2;



		ret = gpio_request(GPIO35_VPAC270_PCMCIA_RDY, "PCMCIA RDY");

		if (ret)

			goto err2;

		ret = gpio_direction_input(GPIO35_VPAC270_PCMCIA_RDY);

		if (ret)

			goto err3;



		ret = gpio_request(GPIO107_VPAC270_PCMCIA_PPEN, "PCMCIA PPEN");

		if (ret)

			goto err3;

		ret = gpio_direction_output(GPIO107_VPAC270_PCMCIA_PPEN, 0);

		if (ret)

			goto err4;



		ret = gpio_request(GPIO11_VPAC270_PCMCIA_RESET, "PCMCIA RESET");

		if (ret)

			goto err4;

		ret = gpio_direction_output(GPIO11_VPAC270_PCMCIA_RESET, 0);

		if (ret)

			goto err5;

		ret = gpio_request_array(vpac270_pcmcia_gpios,

				ARRAY_SIZE(vpac270_pcmcia_gpios));



		skt->socket.pci_irq = gpio_to_irq(GPIO35_VPAC270_PCMCIA_RDY);



		return soc_pcmcia_request_irqs(skt, &cd_irqs[0], 1);



err5:

		gpio_free(GPIO11_VPAC270_PCMCIA_RESET);

err4:

		gpio_free(GPIO107_VPAC270_PCMCIA_PPEN);

err3:

		gpio_free(GPIO35_VPAC270_PCMCIA_RDY);

err2:

		gpio_free(GPIO84_VPAC270_PCMCIA_CD);

err1:

		return ret;



		if (!ret)

			ret = soc_pcmcia_request_irqs(skt, &cd_irqs[0], 1);

	} else {

		ret = gpio_request(GPIO17_VPAC270_CF_CD, "CF CD");

		if (ret)

			goto err6;

		ret = gpio_direction_input(GPIO17_VPAC270_CF_CD);

		if (ret)

			goto err7;



		ret = gpio_request(GPIO12_VPAC270_CF_RDY, "CF RDY");

		if (ret)

			goto err7;

		ret = gpio_direction_input(GPIO12_VPAC270_CF_RDY);

		if (ret)

			goto err8;



		ret = gpio_request(GPIO16_VPAC270_CF_RESET, "CF RESET");

		if (ret)

			goto err8;

		ret = gpio_direction_output(GPIO16_VPAC270_CF_RESET, 0);

		if (ret)

			goto err9;

		ret = gpio_request_array(vpac270_cf_gpios,

				ARRAY_SIZE(vpac270_cf_gpios));



		skt->socket.pci_irq = gpio_to_irq(GPIO12_VPAC270_CF_RDY);



		return soc_pcmcia_request_irqs(skt, &cd_irqs[1], 1);

		if (!ret)

			ret = soc_pcmcia_request_irqs(skt, &cd_irqs[1], 1);

	}



err9:

		gpio_free(GPIO16_VPAC270_CF_RESET);

err8:

		gpio_free(GPIO12_VPAC270_CF_RDY);

err7:

		gpio_free(GPIO17_VPAC270_CF_CD);

err6:

	return ret;



	}

}



static void vpac270_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt)

{

	gpio_free(GPIO11_VPAC270_PCMCIA_RESET);

	gpio_free(GPIO107_VPAC270_PCMCIA_PPEN);

	gpio_free(GPIO35_VPAC270_PCMCIA_RDY);

	gpio_free(GPIO84_VPAC270_PCMCIA_CD);

	gpio_free(GPIO16_VPAC270_CF_RESET);

	gpio_free(GPIO12_VPAC270_CF_RDY);

	gpio_free(GPIO17_VPAC270_CF_CD);

	if (skt->nr == 0)

		gpio_request_array(vpac270_pcmcia_gpios,

					ARRAY_SIZE(vpac270_pcmcia_gpios));

	else

		gpio_request_array(vpac270_cf_gpios,

					ARRAY_SIZE(vpac270_cf_gpios));

}



static void vpac270_pcmcia_socket_state(struct soc_pcmcia_socket *skt,