Aquaris-M10-4G/drivers/misc/mediatek/ssw/fxla2203/fxla2203_driver.c

#include <ssw.h>
#include "cust_ssw_fxla2203.h"
#include "cust_gpio_usage.h"
/*#include <mach/mt_gpio.h>*/

unsigned int ch_swap;
unsigned int en;
unsigned int curr_ssw_mode = SSW_SING_TALK;
struct mutex ssw_mutex;

unsigned int get_sim_switch_type(void)
{
	SSW_DBG("[ccci/ssw]FXLA2203\n");
	return SSW_EXT_FXLA2203;
}

/*sim switch hardware initial*/
static int ssw_init(unsigned int mode)
{
	unsigned int ch_mode, en_mode;

	SSW_DBG("ssw_init: %d\n", mode);
	ch_swap = GPIO_SSW_CH_SWAP_PIN;
	en = GPIO_SSW_EN_PIN;
	ch_mode = GPIO_SSW_CH_SWAP_PIN_M_GPIO;
	en_mode = GPIO_SSW_EN_PIN_M_GPIO;

	/*initial Ch_Swap pin: 1, host1->sim slot1, host2->sim slot2; 0, host1->sim slot2, host2->sim slot1 */
	mt_set_gpio_mode(ch_swap, ch_mode);
	mt_set_gpio_dir(ch_swap, GPIO_DIR_OUT);

	/*initial EN pin: 1, enable sim slot; 0, disable sim slot */
	mt_set_gpio_mode(en, en_mode);
	mt_set_gpio_dir(en, GPIO_DIR_OUT);

	curr_ssw_mode = mode;
	if (mode == SSW_DUAL_TALK)
		mt_set_gpio_out(ch_swap, SSW_DUAL_TALK);
	else if (mode == SSW_SING_TALK)
		mt_set_gpio_out(ch_swap, SSW_SING_TALK);

	mt_set_gpio_out(en, GPIO_OUT_ONE);

	SSW_DBG("ssw_init: ch_swap=(%d %d %d), en=(%d %d %d)\n",
		ch_swap, ch_mode, mt_get_gpio_out(ch_swap),
		en, en_mode, mt_get_gpio_out(en));

	return SSW_SUCCESS;
}

int ssw_switch_mode(char *buf, unsigned int len)
{
	int ret = 0;
	unsigned int mode = *((unsigned int *)buf);
	unsigned int type = (mode & 0xFFFF0000) >> 16;

	if (type != get_sim_switch_type()) {
		SSW_DBG("[Error]sim switch type is mis-match: type(%d, %d)",
			type, get_sim_switch_type());
		return SSW_INVALID_PARA;
	}
	SSW_DBG("sim switch: %d -> %d\n", curr_ssw_mode, mode);

	mutex_lock(&ssw_mutex);

	if (curr_ssw_mode != mode) {
		curr_ssw_mode = mode;

		if (curr_ssw_mode == SSW_DUAL_TALK)
			mt_set_gpio_out(ch_swap, SSW_DUAL_TALK);
		else if (curr_ssw_mode == SSW_SING_TALK)
			mt_set_gpio_out(ch_swap, SSW_SING_TALK);
	}

	mutex_unlock(&ssw_mutex);

	SSW_DBG("sim switch(%d) OK, ch_swap=%d, en=%d\n", curr_ssw_mode,
		mt_get_gpio_out(ch_swap), mt_get_gpio_out(en));

	return SSW_SUCCESS;

}

static int ssw_probe(struct platform_device *dev)
{
	ssw_init(default_mode);
	mutex_init(&ssw_mutex);

	register_ccci_kern_func(ID_SSW_SWITCH_MODE, ssw_switch_mode);

	return 0;
}

static int ssw_remove(struct platform_device *dev)
{
	/*SSW_DBG("ssw_remove\n"); */
	return 0;
}

static void ssw_shutdown(struct platform_device *dev)
{
	/*SSW_DBG("ssw_shutdown\n"); */
}

static int ssw_suspend(struct platform_device *dev, pm_message_t state)
{
	/*SSW_DBG("ssw_suspend\n"); */
	return 0;
}

static int ssw_resume(struct platform_device *dev)
{
	/*SSW_DBG("ssw_resume\n"); */
	return 0;
}

static struct platform_driver ssw_driver = {
	.driver = {
		   .name = "sim-switch",
		   },
	.probe = ssw_probe,
	.remove = ssw_remove,
	.shutdown = ssw_shutdown,
	.suspend = ssw_suspend,
	.resume = ssw_resume,
};

static int __init ssw_driver_init(void)
{
	int ret = 0;

	ret = platform_driver_register(&ssw_driver);
	if (ret) {
		SSW_DBG("ssw_driver register fail(%d)\n", ret);
		return ret;
	}

	return ret;
}

static void __exit ssw_driver_exit(void)
{
}

module_init(ssw_driver_init);
module_exit(ssw_driver_exit);

MODULE_DESCRIPTION("MTK SIM Switch Driver");
MODULE_AUTHOR("Anny <Anny.Hu@mediatek.com>");
MODULE_LICENSE("GPL");