#include <linux/mtk23d.h>
#include <linux/wakelock.h>
#include "../mtd/rknand/api_flash.h"
+#include <linux/slab.h>
MODULE_LICENSE("GPL");
#else
#define MODEMDBG(fmt,argss...)
#endif
-
+#define MTK23D_POWEROFF 0X00
#define MTK23D_RESET 0x01
#define MTK23D_POWERON 0x02
#define MTK23D_POWER_HIGH 0x03
//struct modem_dev *mt6223d_data = NULL;
struct rk2818_23d_data *gpdata = NULL;
-static int get_bp_statue(struct platform_device *pdev)
+static int rk29_uart_to_gpio(int uart_id)
+{
+ if(uart_id == 3) {
+ rk29_mux_api_set(GPIO2B3_UART3SOUT_NAME, GPIO2L_GPIO2B3);
+ rk29_mux_api_set(GPIO2B2_UART3SIN_NAME, GPIO2L_GPIO2B2);
+
+ gpio_request(RK29_PIN2_PB3, NULL);
+ gpio_request(RK29_PIN2_PB2, NULL);
+
+ gpio_direction_output(RK29_PIN2_PB3, GPIO_LOW);
+ gpio_direction_output(RK29_PIN2_PB2, GPIO_LOW);
+ }
+ else if(uart_id == 2) {
+ rk29_mux_api_set(GPIO2B1_UART2SOUT_NAME, GPIO2L_GPIO2B1);
+ rk29_mux_api_set(GPIO2B0_UART2SIN_NAME, GPIO2L_GPIO2B0);
+
+ gpio_request(RK29_PIN2_PB1, NULL);
+ gpio_request(RK29_PIN2_PB0, NULL);
+
+ gpio_direction_output(RK29_PIN2_PB1, GPIO_LOW);
+ gpio_direction_output(RK29_PIN2_PB0, GPIO_LOW);
+ }
+ else if(uart_id == 1) {
+ rk29_mux_api_set(GPIO2A5_UART1SOUT_NAME, GPIO2L_GPIO2A5);
+ rk29_mux_api_set(GPIO2A4_UART1SIN_NAME, GPIO2L_GPIO2A4);
+
+ gpio_request(RK29_PIN2_PA5, NULL);
+ gpio_request(RK29_PIN2_PA4, NULL);
+
+ gpio_direction_output(RK29_PIN2_PA5, GPIO_LOW);
+ gpio_direction_output(RK29_PIN2_PA4, GPIO_LOW);
+ }
+ else if(uart_id == 0){
+ rk29_mux_api_set(GPIO1B7_UART0SOUT_NAME, GPIO1L_GPIO1B7);
+ gpio_request(RK29_PIN1_PB7, NULL);
+ gpio_direction_output(RK29_PIN1_PB7,GPIO_LOW);
+ gpio_pull_updown(RK29_PIN1_PB7, PullDisable); // ÏÂÀ½ûÖ¹
+
+ rk29_mux_api_set(GPIO1B6_UART0SIN_NAME, GPIO1L_GPIO1B6);
+ gpio_request(RK29_PIN1_PB6, NULL);
+ gpio_direction_output(RK29_PIN1_PB6,GPIO_LOW);
+ gpio_pull_updown(RK29_PIN1_PB6, PullDisable); // ÏÂÀ½ûÖ¹
+
+ rk29_mux_api_set(GPIO1C1_UART0RTSN_SDMMC1WRITEPRT_NAME, GPIO1H_GPIO1C1);
+ gpio_request(RK29_PIN1_PC1, NULL);
+ gpio_direction_output(RK29_PIN1_PC1,GPIO_LOW);
+
+ rk29_mux_api_set(GPIO1C0_UART0CTSN_SDMMC1DETECTN_NAME, GPIO1H_GPIO1C0);
+ gpio_request(RK29_PIN1_PC0, NULL);
+ //gpio_direction_input(RK29_PIN1_PC0);
+ gpio_direction_output(RK29_PIN1_PC0,GPIO_LOW);
+ }
+
+ return 0;
+}
+
+static int rk29_gpio_to_uart(int uart_id)
+{
+ if(uart_id == 3) {
+ rk29_mux_api_set(GPIO2B3_UART3SOUT_NAME, GPIO2L_UART3_SOUT);
+ rk29_mux_api_set(GPIO2B2_UART3SIN_NAME, GPIO2L_UART3_SIN);
+
+ gpio_request(RK29_PIN2_PB3, NULL);
+ gpio_request(RK29_PIN2_PB2, NULL);
+
+ gpio_direction_output(RK29_PIN2_PB3, GPIO_HIGH);
+ gpio_direction_output(RK29_PIN2_PB2, GPIO_HIGH);
+ }
+ else if(uart_id == 2) {
+ rk29_mux_api_set(GPIO2B1_UART2SOUT_NAME, GPIO2L_UART2_SOUT);
+ rk29_mux_api_set(GPIO2B0_UART2SIN_NAME, GPIO2L_UART2_SIN);
+
+ gpio_request(RK29_PIN2_PB1, NULL);
+ gpio_request(RK29_PIN2_PB0, NULL);
+
+ gpio_direction_output(RK29_PIN2_PB1, GPIO_HIGH);
+ gpio_direction_output(RK29_PIN2_PB0, GPIO_HIGH);
+ }
+ else if(uart_id == 1) {
+ rk29_mux_api_set(GPIO2A5_UART1SOUT_NAME, GPIO2L_UART1_SOUT);
+ rk29_mux_api_set(GPIO2A4_UART1SIN_NAME, GPIO2L_UART1_SIN);
+
+ gpio_request(RK29_PIN2_PA5, NULL);
+ gpio_request(RK29_PIN2_PA4, NULL);
+
+ gpio_direction_output(RK29_PIN2_PA5, GPIO_HIGH);
+ gpio_direction_output(RK29_PIN2_PA4, GPIO_HIGH);
+ }
+ else if(uart_id == 0){
+ rk29_mux_api_set(GPIO1B7_UART0SOUT_NAME, GPIO1L_UART0_SOUT);
+ rk29_mux_api_set(GPIO1B6_UART0SIN_NAME, GPIO1L_UART0_SIN);
+ rk29_mux_api_set(GPIO1C1_UART0RTSN_SDMMC1WRITEPRT_NAME, GPIO1H_UART0_RTS_N);
+ rk29_mux_api_set(GPIO1C0_UART0CTSN_SDMMC1DETECTN_NAME, GPIO1H_UART0_CTS_N);
+ }
+
+ return 0;
+
+}
+
+/*static int get_bp_statue(struct platform_device *pdev)
{
struct rk2818_23d_data *pdata = pdev->dev.platform_data;
return SLEEP;
else
return READY;
-}
+}*/
static void ap_sleep(struct platform_device *pdev)
{
struct rk2818_23d_data *pdata = pdev->dev.platform_data;
static void ap_wakeup_bp(struct platform_device *pdev, int wake)//low to wakeup bp
{
struct rk2818_23d_data *pdata = pdev->dev.platform_data;
- struct modem_dev *mt6223d_data = platform_get_drvdata(pdev);
+ //struct modem_dev *mt6223d_data = platform_get_drvdata(pdev);
MODEMDBG("ap_wakeup_bp\n");
gpio_set_value(pdata->ap_bp_wakeup, wake); // phc
static void bpwakeup_work_func_work(struct work_struct *work)
{
- struct modem_dev *bdata = container_of(work, struct modem_dev, work);
+ //struct modem_dev *bdata = container_of(work, struct modem_dev, work);
MODEMDBG("%s\n", __FUNCTION__);
}
-/* */
+/*
static irqreturn_t bpwakeup_work_func(int irq, void *data)
{
struct modem_dev *mt6223d_data = (struct modem_dev *)data;
schedule_work(&mt6223d_data->work);
return IRQ_HANDLED;
}
+
+
static irqreturn_t bp_apwakeup_work_func(int irq, void *data)
{
//struct modem_dev *dev = &mtk23d_misc;
//wake_up_interruptible(&dev->wakeup);
return IRQ_HANDLED;
}
+*/
static irqreturn_t BBwakeup_isr(int irq, void *dev_id)
{
- struct rk2818_23d_data *pdata = dev_id;
+ //struct rk2818_23d_data *pdata = dev_id;
MODEMDBG("%s \n", __FUNCTION__);
//if(irq != gpio_to_irq(RK29_PIN1_PC0))
int modem_poweron_off(int on_off)
{
struct rk2818_23d_data *pdata = gpdata;
- int result, error = 0, irq = 0;
+ int error = 0, irq = 0;
if(on_off)
- {
- printk("modem_poweron\n");
-
- gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_LOW:GPIO_HIGH); // power on enable
- mdelay(300);
- gpio_set_value(pdata->bp_reset, pdata->bp_reset_active_low? GPIO_HIGH:GPIO_LOW); // release reset
- msleep(3000);
- gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_HIGH:GPIO_LOW); // power on relase
-
- #if 1 // phc
- rk29_mux_api_set(GPIO1B7_UART0SOUT_NAME, GPIO1L_UART0_SOUT);
- rk29_mux_api_set(GPIO1B6_UART0SIN_NAME, GPIO1L_UART0_SIN);
- rk29_mux_api_set(GPIO1C1_UART0RTSN_SDMMC1WRITEPRT_NAME, GPIO1H_UART0_RTS_N);
- rk29_mux_api_set(GPIO1C0_UART0CTSN_SDMMC1DETECTN_NAME, GPIO1H_UART0_CTS_N);
- #endif
-
- gpio_direction_input(pdata->bp_statue);
- gpio_direction_input(pdata->bp_ap_wakeup);
-
- /* ³õʼ»¯BP»½ÐÑAPµÄ¹¦ÄÜ */
- wakelock_inited = false;
- irq = gpio_to_irq(pdata->bp_statue);
- if (irq < 0) {
- printk("can't get pdata->bp_statue irq \n");
- }
- else
- {
- error = request_irq(irq, BBwakeup_isr,
- IRQF_TRIGGER_FALLING,
- NULL,
- pdata);
- if (error) {
- printk("mtk23d_probe bp_statue request_irq error!!! \n");
- }
- }
- if (!wakelock_inited) {
- wake_lock_init(&mtk23d_wakelock, WAKE_LOCK_SUSPEND, "23d_resume");
- wakelock_inited = true;
+ {
+ printk("modem_poweron\n");
+
+ gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_LOW:GPIO_HIGH); // power on enable
+ mdelay(300);
+ gpio_set_value(pdata->bp_reset, pdata->bp_reset_active_low? GPIO_HIGH:GPIO_LOW); // release reset
+ msleep(3000);
+ gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_HIGH:GPIO_LOW); // power on relase
+
+ rk29_gpio_to_uart(0);
+
+ gpio_direction_input(pdata->bp_statue);
+ if(pdata->bp_ap_wakeup) // SDK°åÖУ¬¸Ã¿ÚûÓÐÒý³ö
+ gpio_direction_input(pdata->bp_ap_wakeup);
+
+ /* ³õʼ»¯BP»½ÐÑAPµÄ¹¦ÄÜ */
+ wakelock_inited = false;
+ irq = gpio_to_irq(pdata->bp_statue);
+ if (irq < 0) {
+ printk("can't get pdata->bp_statue irq \n");
+ }
+ else
+ {
+ error = request_irq(irq, BBwakeup_isr,IRQF_TRIGGER_FALLING, "mtk23d", pdata);
+ if (error) {
+ printk("mtk23d_probe bp_statue request_irq error!!! \n");
}
- }
+ }
+ if (!wakelock_inited) {
+ wake_lock_init(&mtk23d_wakelock, WAKE_LOCK_SUSPEND, "23d_resume");
+ wakelock_inited = true;
+ }
+ }
else
{
printk("modem_poweroff\n");
+ rk29_uart_to_gpio(0);
gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_LOW:GPIO_HIGH);
- mdelay(100);
+ msleep(2500);
gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_HIGH:GPIO_LOW);
+ msleep(500);
+ gpio_set_value(pdata->bp_reset, pdata->bp_reset_active_low? GPIO_LOW:GPIO_HIGH);
}
+ return 0;
}
static int power_on =1;
static int mtk23d_open(struct inode *inode, struct file *file)
{
struct rk2818_23d_data *pdata = gpdata;
- //struct rk2818_23d_data *pdata = gpdata = pdev->dev.platform_data;
- struct platform_data *pdev = container_of(pdata, struct device, platform_data);
-
MODEMDBG("modem_open\n");
- int ret = 0;
if(power_on)
{
power_on = 0;
modem_poweron_off(1);
}
- device_init_wakeup(&pdev, 1);
-
+ device_init_wakeup(pdata->dev, 1);
return 0;
}
-
static int mtk23d_release(struct inode *inode, struct file *file)
{
MODEMDBG("mtk23d_release\n");
//extern char imei_value[16]; // phc, no find 'imei_value' in rk29 project
//char imei_value[16] = {0,1,2,3,4,5,6,7,8,9,0,1,2,3,4,5};
-static int mtk23d_ioctl(struct inode *inode,struct file *file, unsigned int cmd, unsigned long arg)
+
+static long mtk23d_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
struct rk2818_23d_data *pdata = gpdata;
- int i;
+ int ret;
void __user *argp = (void __user *)arg;
char SectorBuffer[512];
printk("mtk23d_ioctl\n");
+ ret = down_interruptible(&pdata->power_sem);
+ if (ret < 0) {
+ printk("%s: down power_sem error ret = %d\n", __func__, ret);
+ return ret;
+ }
+
switch(cmd)
{
+
+ case MTK23D_POWEROFF:
+ printk("MTK23D_POWEROFF\n");
+ rk29_uart_to_gpio(0);
+ gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_LOW:GPIO_HIGH);
+ msleep(2500);
+ gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_HIGH:GPIO_LOW);
+ msleep(500);
+ gpio_set_value(pdata->bp_reset, pdata->bp_reset_active_low? GPIO_LOW:GPIO_HIGH);
+ break;
+
case MTK23D_RESET:
printk("MTK23D_RESET\n");
+ /****power off 23d and uart to gpio***/
+ rk29_uart_to_gpio(0);
+ gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_LOW:GPIO_HIGH);
+ msleep(2500);
+ gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_HIGH:GPIO_LOW);
+ msleep(500);
+ gpio_set_value(pdata->bp_reset, pdata->bp_reset_active_low? GPIO_LOW:GPIO_HIGH);
+
+ /****power on 23d***/
+ msleep(100);
+ gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_LOW:GPIO_HIGH);
+ rk29_gpio_to_uart(0);
+ msleep(300);
+ gpio_set_value(pdata->bp_reset, pdata->bp_reset_active_low? GPIO_HIGH:GPIO_LOW);
+ msleep(2500);
+ gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_HIGH:GPIO_LOW);
+ break;
+
+ case MTK23D_POWERON:
+ /****power on 23d***/
+ printk("MTK23D_POWERON\n");
gpio_set_value(pdata->bp_reset, pdata->bp_reset_active_low? GPIO_LOW:GPIO_HIGH);
- mdelay(100);
+ msleep(100);
gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_LOW:GPIO_HIGH);
- mdelay(300);
+ rk29_gpio_to_uart(0);
+ msleep(300);
gpio_set_value(pdata->bp_reset, pdata->bp_reset_active_low? GPIO_HIGH:GPIO_LOW);
- msleep(3000);
+ msleep(2500);
gpio_set_value(pdata->bp_power, pdata->bp_power_active_low? GPIO_HIGH:GPIO_LOW);
break;
+
case MTK23D_IMEI_READ:
printk("MTK23D_IMEI_READ\n");
if(copy_to_user(argp, &(SectorBuffer[451]), 16)) // IMEIºó´Ó451Æ«ÒÆ¿ªÊ¼µÄ16bytes£¬µÚÒ»¸öbyteΪ³¤¶È¹Ì¶¨Îª15
{
printk("ERROR: copy_to_user---%s\n", __FUNCTION__);
+ up(&pdata->power_sem);
return -EFAULT;
}
//printk("IMEI:%d %d %d %d\n", SectorBuffer[451], SectorBuffer[452], SectorBuffer[453], SectorBuffer[454]);
default:
break;
}
+
+ up(&pdata->power_sem);
+
return 0;
}
.owner = THIS_MODULE,
.open = mtk23d_open,
.release = mtk23d_release,
- .ioctl = mtk23d_ioctl
+ .unlocked_ioctl = mtk23d_ioctl
};
static struct miscdevice mtk23d_misc = {
{
struct rk2818_23d_data *pdata = gpdata = pdev->dev.platform_data;
struct modem_dev *mt6223d_data = NULL;
- int result, error = 0, irq = 0;
+ int result=1;
MODEMDBG("mtk23d_probe\n");
//pdata->io_init();
+ pdata->dev = &pdev->dev;
mt6223d_data = kzalloc(sizeof(struct modem_dev), GFP_KERNEL);
if(NULL == mt6223d_data)
}
#if 1 // GPIO³õʼ»¯£¬²¢ÇÒ·Àֹ©µç
- rk29_mux_api_set(GPIO1B7_UART0SOUT_NAME, GPIO1L_GPIO1B7);
- gpio_request(RK29_PIN1_PB7, NULL);
- gpio_direction_output(RK29_PIN1_PB7,GPIO_LOW);
- gpio_pull_updown(RK29_PIN1_PB7, PullDisable); // ÏÂÀ½ûÖ¹
-
- rk29_mux_api_set(GPIO1B6_UART0SIN_NAME, GPIO1L_GPIO1B6);
- gpio_request(RK29_PIN1_PB6, NULL);
- gpio_direction_output(RK29_PIN1_PB6,GPIO_LOW);
- gpio_pull_updown(RK29_PIN1_PB6, PullDisable); // ÏÂÀ½ûÖ¹
-
- rk29_mux_api_set(GPIO1C1_UART0RTSN_SDMMC1WRITEPRT_NAME, GPIO1H_GPIO1C1);
- gpio_request(RK29_PIN1_PC1, NULL);
- gpio_direction_output(RK29_PIN1_PC1,GPIO_LOW);
-
- rk29_mux_api_set(GPIO1C0_UART0CTSN_SDMMC1DETECTN_NAME, GPIO1H_GPIO1C0);
- gpio_request(RK29_PIN1_PC0, NULL);
- //gpio_direction_input(RK29_PIN1_PC0);
- gpio_direction_output(RK29_PIN1_PC0,GPIO_LOW);
-
+ rk29_uart_to_gpio(0);
- gpio_direction_output(pdata->bp_power, GPIO_LOW);
+ /***power off 23d***/
+ gpio_direction_output(pdata->bp_power, pdata->bp_power_active_low? GPIO_LOW:GPIO_HIGH);
+
gpio_direction_output(pdata->ap_statue, GPIO_LOW);
gpio_direction_output(pdata->ap_bp_wakeup, GPIO_LOW);
- gpio_direction_output(pdata->bp_reset, GPIO_LOW);
//gpio_direction_output(pdata->bp_statue,GPIO_LOW);
gpio_direction_input(pdata->bp_statue);
if(pdata->bp_ap_wakeup) // SDK°åÖУ¬¸Ã¿ÚûÓÐÒý³ö
//gpio_direction_output(pdata->bp_ap_wakeup,GPIO_LOW);
gpio_direction_input(pdata->bp_ap_wakeup);
}
-
+
/*¸´Î»BP*/
gpio_set_value(pdata->bp_reset, pdata->bp_reset_active_low? GPIO_LOW:GPIO_HIGH);
//mdelay(200);
#endif
INIT_WORK(&mt6223d_data->work, bpwakeup_work_func_work);
- power_on = 1;
+ sema_init(&pdata->power_sem,1);
+ power_on = 1;
result = misc_register(&mtk23d_misc);
if(result)
{
gpio_free(pdata->bp_statue);
err6:
kfree(mt6223d_data);
-ret:
+
return result;
}
-int mtk23d_suspend(struct platform_device *pdev)
+int mtk23d_suspend(struct platform_device *pdev, pm_message_t state)
{
- int irq, error;
+ int irq;
struct rk2818_23d_data *pdata = pdev->dev.platform_data;
MODEMDBG("%s \n", __FUNCTION__);
return 0;
}
-void mtk23d_shutdown(struct platform_device *pdev, pm_message_t state)
+void mtk23d_shutdown(struct platform_device *pdev)
{
struct rk2818_23d_data *pdata = pdev->dev.platform_data;
struct modem_dev *mt6223d_data = platform_get_drvdata(pdev);
},
};
+
static int __init mtk23d_init(void)
{
- MODEMDBG("mtk23d_init ret=%d\n");
+ //MODEMDBG("mtk23d_init ret=%d\n");
return platform_driver_register(&mtk23d_driver);
}
projects / firefly-linux-kernel-4.4.55.git / blobdiff