/* Copyright (c) 2011-2013, The Linux Foundation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "msm_watchdog.h" #include "devices.h" #include "clock.h" #include "mdm_private.h" #define MDM_PBLRDY_CNT 20 static int mdm_debug_mask; static void mdm_peripheral_connect(struct mdm_modem_drv *mdm_drv) { if (!mdm_drv->pdata->peripheral_platform_device) return; mutex_lock(&mdm_drv->peripheral_status_lock); if (mdm_drv->peripheral_status) goto out; platform_device_add(mdm_drv->pdata->peripheral_platform_device); mdm_drv->peripheral_status = 1; out: mutex_unlock(&mdm_drv->peripheral_status_lock); } static void mdm_peripheral_disconnect(struct mdm_modem_drv *mdm_drv) { if (!mdm_drv->pdata->peripheral_platform_device) return; mutex_lock(&mdm_drv->peripheral_status_lock); if (!mdm_drv->peripheral_status) goto out; platform_device_del(mdm_drv->pdata->peripheral_platform_device); mdm_drv->peripheral_status = 0; out: mutex_unlock(&mdm_drv->peripheral_status_lock); } /* This function can be called from atomic context. */ static void mdm_toggle_soft_reset(struct mdm_modem_drv *mdm_drv) { int soft_reset_direction_assert = 0, soft_reset_direction_de_assert = 1; if (mdm_drv->pdata->soft_reset_inverted) { soft_reset_direction_assert = 1; soft_reset_direction_de_assert = 0; } gpio_direction_output(mdm_drv->ap2mdm_soft_reset_gpio, soft_reset_direction_assert); /* Use mdelay because this function can be called from atomic * context. */ mdelay(10); gpio_direction_output(mdm_drv->ap2mdm_soft_reset_gpio, soft_reset_direction_de_assert); } /* This function can be called from atomic context. */ static void mdm_atomic_soft_reset(struct mdm_modem_drv *mdm_drv) { mdm_toggle_soft_reset(mdm_drv); } static void mdm_power_down_common(struct mdm_modem_drv *mdm_drv) { int i; int soft_reset_direction = mdm_drv->pdata->soft_reset_inverted ? 1 : 0; mdm_peripheral_disconnect(mdm_drv); /* Wait for the modem to complete its power down actions. */ for (i = 20; i > 0; i--) { if (gpio_get_value(mdm_drv->mdm2ap_status_gpio) == 0) { if (mdm_debug_mask & MDM_DEBUG_MASK_SHDN_LOG) pr_debug("%s:id %d: mdm2ap_statuswent low, i=%d\n", __func__, mdm_drv->device_id, i); break; } msleep(100); } /* Assert the soft reset line whether mdm2ap_status went low or not */ gpio_direction_output(mdm_drv->ap2mdm_soft_reset_gpio, soft_reset_direction); if (i == 0) { pr_debug("%s:id %d: MDM2AP_STATUS never went low. Doing a hard reset\n", __func__, mdm_drv->device_id); gpio_direction_output(mdm_drv->ap2mdm_soft_reset_gpio, soft_reset_direction); /* * Currently, there is a debounce timer on the charm PMIC. It is * necessary to hold the PMIC RESET low for ~3.5 seconds * for the reset to fully take place. Sleep here to ensure the * reset has occured before the function exits. */ msleep(4000); } } static void mdm_do_first_power_on(struct mdm_modem_drv *mdm_drv) { int i; int pblrdy; if (mdm_drv->power_on_count != 1) { pr_debug("%s:id %d: Calling fn when power_on_count != 1\n", __func__, mdm_drv->device_id); return; } pr_debug("%s:id %d: Powering on modem for the first time\n", __func__, mdm_drv->device_id); mdm_peripheral_disconnect(mdm_drv); /* If this is the first power-up after a panic, the modem may still * be in a power-on state, in which case we need to toggle the gpio * instead of just de-asserting it. No harm done if the modem was * powered down. */ mdm_toggle_soft_reset(mdm_drv); /* If the device has a kpd pwr gpio then toggle it. */ if (GPIO_IS_VALID(mdm_drv->ap2mdm_kpdpwr_n_gpio)) { /* Pull AP2MDM_KPDPWR gpio high and wait for PS_HOLD to settle, * then pull it back low. */ pr_debug("%s:id %d: Pulling AP2MDM_KPDPWR gpio high\n", __func__, mdm_drv->device_id); gpio_direction_output(mdm_drv->ap2mdm_kpdpwr_n_gpio, 1); gpio_direction_output(mdm_drv->ap2mdm_status_gpio, 1); msleep(1000); gpio_direction_output(mdm_drv->ap2mdm_kpdpwr_n_gpio, 0); } else { gpio_direction_output(mdm_drv->ap2mdm_status_gpio, 1); } if (!GPIO_IS_VALID(mdm_drv->mdm2ap_pblrdy)) goto start_mdm_peripheral; for (i = 0; i < MDM_PBLRDY_CNT; i++) { pblrdy = gpio_get_value(mdm_drv->mdm2ap_pblrdy); if (pblrdy) break; usleep_range(5000, 5000); } pr_debug("%s: id %d: pblrdy i:%d\n", __func__, mdm_drv->device_id, i); start_mdm_peripheral: mdm_peripheral_connect(mdm_drv); msleep(200); } static void mdm_do_soft_power_on(struct mdm_modem_drv *mdm_drv) { int i; int pblrdy; pr_debug("%s: id %d: soft resetting mdm modem\n", __func__, mdm_drv->device_id); mdm_peripheral_disconnect(mdm_drv); mdm_toggle_soft_reset(mdm_drv); if (!GPIO_IS_VALID(mdm_drv->mdm2ap_pblrdy)) goto start_mdm_peripheral; for (i = 0; i < MDM_PBLRDY_CNT; i++) { pblrdy = gpio_get_value(mdm_drv->mdm2ap_pblrdy); if (pblrdy) break; usleep_range(5000, 5000); } pr_debug("%s: id %d: pblrdy i:%d\n", __func__, mdm_drv->device_id, i); start_mdm_peripheral: mdm_peripheral_connect(mdm_drv); msleep(200); } static void mdm_power_on_common(struct mdm_modem_drv *mdm_drv) { mdm_drv->power_on_count++; /* this gpio will be used to indicate apq readiness, * de-assert it now so that it can be asserted later. * May not be used. */ if (GPIO_IS_VALID(mdm_drv->ap2mdm_wakeup_gpio)) gpio_direction_output(mdm_drv->ap2mdm_wakeup_gpio, 0); /* * If we did an "early power on" then ignore the very next * power-on request because it would the be first request from * user space but we're already powered on. Ignore it. */ if (mdm_drv->pdata->early_power_on && (mdm_drv->power_on_count == 2)) return; if (mdm_drv->power_on_count == 1) mdm_do_first_power_on(mdm_drv); else mdm_do_soft_power_on(mdm_drv); } static void debug_state_changed(int value) { mdm_debug_mask = value; } static void mdm_status_changed(struct mdm_modem_drv *mdm_drv, int value) { pr_debug("%s: id %d: value:%d\n", __func__, value, mdm_drv->device_id); if (value) { mdm_peripheral_disconnect(mdm_drv); mdm_peripheral_connect(mdm_drv); if (GPIO_IS_VALID(mdm_drv->ap2mdm_wakeup_gpio)) gpio_direction_output(mdm_drv->ap2mdm_wakeup_gpio, 1); } } static void mdm_image_upgrade(struct mdm_modem_drv *mdm_drv, int type) { switch (type) { case APQ_CONTROLLED_UPGRADE: pr_debug("%s: id %d: APQ controlled modem image upgrade\n", __func__, mdm_drv->device_id); atomic_set(&mdm_drv->mdm_ready, 0); mdm_toggle_soft_reset(mdm_drv); break; case MDM_CONTROLLED_UPGRADE: pr_debug("%s: id %d: MDM controlled modem image upgrade\n", __func__, mdm_drv->device_id); atomic_set(&mdm_drv->mdm_ready, 0); /* * If we have no image currently present on the modem, then we * would be in PBL, in which case the status gpio would not go * high. */ mdm_drv->disable_status_check = 1; if (GPIO_IS_VALID(mdm_drv->usb_switch_gpio)) { pr_debug("%s: id %d: Switching usb control to MDM\n", __func__, mdm_drv->device_id); gpio_direction_output(mdm_drv->usb_switch_gpio, 1); } else pr_err("%s: id %d: usb switch gpio unavailable\n", __func__, mdm_drv->device_id); break; default: pr_err("%s: id %d: invalid upgrade type\n", __func__, mdm_drv->device_id); } } static struct mdm_ops mdm_cb = { .power_on_mdm_cb = mdm_power_on_common, .reset_mdm_cb = mdm_power_on_common, .atomic_reset_mdm_cb = mdm_atomic_soft_reset, .power_down_mdm_cb = mdm_power_down_common, .debug_state_changed_cb = debug_state_changed, .status_cb = mdm_status_changed, .image_upgrade_cb = mdm_image_upgrade, }; int mdm_get_ops(struct mdm_ops **mdm_ops) { *mdm_ops = &mdm_cb; return 0; }