@ -47,6 +47,7 @@
# include <linux/delay.h>
# include <linux/device.h>
# include <linux/dma-mapping.h>
# include <linux/phy/phy.h>
# include <linux/platform_device.h>
# include <linux/module.h>
# include <linux/idr.h>
@ -298,6 +299,49 @@ static void hw_phymode_configure(struct ci_hdrc *ci)
}
}
/**
* _ci_usb_phy_init : initialize phy taking in account both phy and usb_phy
* interfaces
* @ ci : the controller
*
* This function returns an error code if the phy failed to init
*/
static int _ci_usb_phy_init ( struct ci_hdrc * ci )
{
int ret ;
if ( ci - > phy ) {
ret = phy_init ( ci - > phy ) ;
if ( ret )
return ret ;
ret = phy_power_on ( ci - > phy ) ;
if ( ret ) {
phy_exit ( ci - > phy ) ;
return ret ;
}
} else {
ret = usb_phy_init ( ci - > usb_phy ) ;
}
return ret ;
}
/**
* _ci_usb_phy_exit : deinitialize phy taking in account both phy and usb_phy
* interfaces
* @ ci : the controller
*/
static void ci_usb_phy_exit ( struct ci_hdrc * ci )
{
if ( ci - > phy ) {
phy_power_off ( ci - > phy ) ;
phy_exit ( ci - > phy ) ;
} else {
usb_phy_shutdown ( ci - > usb_phy ) ;
}
}
/**
* ci_usb_phy_init : initialize phy according to different phy type
* @ ci : the controller
@ -312,7 +356,7 @@ static int ci_usb_phy_init(struct ci_hdrc *ci)
case USBPHY_INTERFACE_MODE_UTMI :
case USBPHY_INTERFACE_MODE_UTMIW :
case USBPHY_INTERFACE_MODE_HSIC :
ret = usb_phy_init ( ci - > usb_phy ) ;
ret = _ci_ usb_phy_init( ci ) ;
if ( ret )
return ret ;
hw_phymode_configure ( ci ) ;
@ -320,12 +364,12 @@ static int ci_usb_phy_init(struct ci_hdrc *ci)
case USBPHY_INTERFACE_MODE_ULPI :
case USBPHY_INTERFACE_MODE_SERIAL :
hw_phymode_configure ( ci ) ;
ret = usb_phy_init ( ci - > usb_phy ) ;
ret = _ci_ usb_phy_init( ci ) ;
if ( ret )
return ret ;
break ;
default :
ret = usb_phy_init ( ci - > usb_phy ) ;
ret = _ci_ usb_phy_init( ci ) ;
}
return ret ;
@ -605,23 +649,26 @@ static int ci_hdrc_probe(struct platform_device *pdev)
return - ENODEV ;
}
if ( ci - > platdata - > usb_phy )
if ( ci - > platdata - > phy ) {
ci - > phy = ci - > platdata - > phy ;
} else if ( ci - > platdata - > usb_phy ) {
ci - > usb_phy = ci - > platdata - > usb_phy ;
else
} else {
ci - > phy = devm_phy_get ( dev , " usb-phy " ) ;
ci - > usb_phy = devm_usb_get_phy ( dev , USB_PHY_TYPE_USB2 ) ;
if ( IS_ERR ( ci - > usb_phy ) ) {
ret = PTR_ERR ( ci - > usb_phy ) ;
/*
* if - ENXIO is returned , it means PHY layer wasn ' t
* enabled , so it makes no sense to return - EPROBE_DEFER
* in that case , since no PHY driver will ever probe .
*/
if ( ret = = - ENXIO )
return ret ;
/* if both generic PHY and USB PHY layers aren't enabled */
if ( PTR_ERR ( ci - > phy ) = = - ENOSYS & &
PTR_ERR ( ci - > usb_phy ) = = - ENXIO )
return - ENXIO ;
if ( IS_ERR ( ci - > phy ) & & IS_ERR ( ci - > usb_phy ) )
return - EPROBE_DEFER ;
dev_err ( dev , " no usb2 phy configured \n " ) ;
return - EPROBE_DEFER ;
if ( IS_ERR ( ci - > phy ) )
ci - > phy = NULL ;
else if ( IS_ERR ( ci - > usb_phy ) )
ci - > usb_phy = NULL ;
}
ret = ci_usb_phy_init ( ci ) ;
@ -728,7 +775,7 @@ static int ci_hdrc_probe(struct platform_device *pdev)
stop :
ci_role_destroy ( ci ) ;
deinit_phy :
usb_phy_shutdown ( ci - > usb_phy ) ;
ci_usb_phy_exit ( ci ) ;
return ret ;
}
@ -741,7 +788,7 @@ static int ci_hdrc_remove(struct platform_device *pdev)
free_irq ( ci - > irq , ci ) ;
ci_role_destroy ( ci ) ;
ci_hdrc_enter_lpm ( ci , true ) ;
usb_phy_shutdown ( ci - > usb_phy ) ;
ci_usb_phy_exit ( ci ) ;
return 0 ;
}