static void ux500_uart0_exit(void)
{
int ret;
ret = nmk_config_pins_sleep(mop500_pins_uart0,
ARRAY_SIZE(mop500_pins_uart0));
if (ret < 0)
pr_err("pl011: uart pins_disable failed\n");
}
static int stm_disable_modem_microsd(void)
{
int retval;
/* Reconfigure GPIO for SD */
retval = nmk_config_pins_sleep(ARRAY_AND_SIZE(mop500_sdi0_pins));
if (retval)
STM_ERR("Failed to disable STM MODEM on MICRO SD "
"and to reconfigure GPIO for SD\n");
return retval;
}
static int stm_ste_disable_ape_on_mipi60(void)
{
int retval;
retval = nmk_config_pins_sleep(ARRAY_AND_SIZE(mop500_stm_mipi60_pins));
if (retval)
STM_ERR("Failed to disable MIPI60\n");
else {
retval = nmk_config_pins(ARRAY_AND_SIZE(mop500_ske_pins));
if (retval)
STM_ERR("Failed to enable SKE gpio\n");
}
return retval;
}
static int stm_disable_ape_microsd(void)
{
int retval;
/* Disable altC1 on GPIO23-28 (STMAPE) */
prcmu_disable_stm_ape();
/* Reconfigure GPIO for SD */
retval = nmk_config_pins_sleep(ARRAY_AND_SIZE(mop500_sdi0_pins));
if (retval)
STM_ERR("Failed to disable STM APE on MICRO SD "
"and to reconfigure GPIO for SD\n");
return retval;
}
int msp13_i2s_exit(void)
{
int retval = 0;
unsigned long flags;
spin_lock_irqsave(&msp_rxtx_lock, flags);
WARN_ON(!msp_rxtx_ref);
msp_rxtx_ref--;
if (msp_rxtx_ref == 0)
retval = nmk_config_pins_sleep(
ARRAY_AND_SIZE(mop500_msp1_pins_exit));
spin_unlock_irqrestore(&msp_rxtx_lock, flags);
return retval;
}
static int stm_ste_connection(enum stm_connection_type con_type)
{
int retval = -EINVAL;
/* Check if connection type has been changed */
if (con_type == stm_current_connection)
return 0;
if (con_type != STM_DISCONNECT) {
/* Always enable MIPI34 GPIO pins */
retval = nmk_config_pins(
ARRAY_AND_SIZE(mop500_stm_mipi34_pins));
if (retval) {
STM_ERR("Failed to enable MIPI34\n");
goto stm_ste_connection_error;
}
}
switch (con_type) {
case STM_DEFAULT_CONNECTION:
case STM_STE_MODEM_ON_MIPI34_NONE_ON_MIPI60:
/* Enable altC3 on GPIO70-74 (STMMOD) & GPIO75-76 (UARTMOD) */
prcmu_enable_stm_mod_uart();
retval = stm_ste_disable_ape_on_mipi60();
break;
case STM_STE_APE_ON_MIPI34_NONE_ON_MIPI60:
/* Disable altC3 on GPIO70-74 (STMMOD) & GPIO75-76 (UARTMOD) */
prcmu_disable_stm_mod_uart();
retval = stm_ste_disable_ape_on_mipi60();
break;
case STM_STE_MODEM_ON_MIPI34_APE_ON_MIPI60:
/* Enable altC3 on GPIO70-74 (STMMOD) and GPIO75-76 (UARTMOD) */
prcmu_enable_stm_mod_uart();
/* Enable APE on MIPI60 */
if (!machine_is_snowball())
retval = nmk_config_pins_sleep(ARRAY_AND_SIZE(mop500_ske_pins));
if (retval)
STM_ERR("Failed to disable SKE GPIO\n");
else {
retval = nmk_config_pins(
ARRAY_AND_SIZE(mop500_stm_mipi60_pins));
if (retval)
STM_ERR("Failed to enable MIPI60\n");
}
break;
case STM_STE_MODEM_ON_MICROSD:
/* Disable APE on micro SD */
retval = stm_disable_ape_microsd();
/* Enable modem on micro SD */
if (!retval)
retval = stm_enable_modem_microsd();
/* Enable SD card buffer and regulator on href */
if (!retval && (stm_current_connection
!= STM_STE_APE_ON_MICROSD)) {
enable_level_shifter_for_microsd();
enable_vaux3_for_microsd_cable();
}
break;
case STM_STE_APE_ON_MICROSD:
/* Disable modem on micro SD */
retval = stm_disable_modem_microsd();
/* Enable ape on micro SD */
if (!retval)
retval = stm_enable_ape_microsd();
/* Enable SD card buffer and regulator on href */
if (!retval && (stm_current_connection
!= STM_STE_MODEM_ON_MICROSD)) {
enable_level_shifter_for_microsd();
enable_vaux3_for_microsd_cable();
}
break;
case STM_DISCONNECT:
retval = nmk_config_pins_sleep(
ARRAY_AND_SIZE(mop500_stm_mipi34_pins));
if (retval)
STM_ERR("Failed to disable MIPI34\n");
retval = stm_ste_disable_ape_on_mipi60();
if (retval)
STM_ERR("Failed to disable MIPI60\n");
retval = stm_disable_modem_microsd();
if (retval)
STM_ERR("Failed to disable modem on microsd\n");
retval = stm_disable_ape_microsd();
if (retval)
STM_ERR("Failed to disable ape on microsd\n");
break;
default:
STM_ERR("Bad connection type\n");
goto stm_ste_connection_error;
}
/* Disable power for microsd */
if ((stm_current_connection == STM_STE_MODEM_ON_MICROSD)
|| (stm_current_connection == STM_STE_APE_ON_MICROSD)) {
if ((con_type != STM_STE_MODEM_ON_MICROSD)
&& (con_type != STM_STE_APE_ON_MICROSD)) {
disable_vaux3_for_microsd_cable();
disable_level_shifter_for_microsd();
}
}
stm_current_connection = con_type;
stm_ste_connection_error:
return retval;
}
