Add ULPI detection function.
Added ULPI detection function. Same function from isp1504 driver removed. Used implementation from Linux kernel. Signed-off-by: Alexander Shiyan <shc_work@mail.ru> Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
This commit is contained in:
parent
9c01d10dab
commit
2079f13611
|
@ -4,18 +4,10 @@
|
|||
|
||||
int isp1504_set_vbus_power(void __iomem *view, int on)
|
||||
{
|
||||
int vid, pid, ret = 0;
|
||||
int ret = 0;
|
||||
|
||||
vid = (ulpi_read(ULPI_VID_HIGH, view) << 8) |
|
||||
ulpi_read(ULPI_VID_LOW, view);
|
||||
pid = (ulpi_read(ULPI_PID_HIGH, view) << 8) |
|
||||
ulpi_read(ULPI_PID_LOW, view);
|
||||
|
||||
pr_info("ULPI Vendor ID 0x%x Product ID 0x%x\n", vid, pid);
|
||||
if (vid != 0x4cc || pid != 0x1504) {
|
||||
pr_err("No ISP1504 found\n");
|
||||
if (ulpi_init(view))
|
||||
return -1;
|
||||
}
|
||||
|
||||
if (on) {
|
||||
ret = ulpi_set(DRV_VBUS_EXT | /* enable external Vbus */
|
||||
|
|
|
@ -116,3 +116,48 @@ int ulpi_clear(u8 bits, int reg, void __iomem *view)
|
|||
}
|
||||
EXPORT_SYMBOL(ulpi_clear);
|
||||
|
||||
struct ulpi_info {
|
||||
uint32_t id;
|
||||
char *name;
|
||||
};
|
||||
|
||||
#define ULPI_ID(vendor, product) (((vendor) << 16) | (product))
|
||||
#define ULPI_INFO(_id, _name) \
|
||||
{ \
|
||||
.id = (_id), \
|
||||
.name = (_name), \
|
||||
}
|
||||
|
||||
/* ULPI hardcoded IDs, used for probing */
|
||||
static struct ulpi_info ulpi_ids[] = {
|
||||
ULPI_INFO(ULPI_ID(0x04cc, 0x1504), "NXP ISP1504"),
|
||||
ULPI_INFO(ULPI_ID(0x0424, 0x0006), "SMSC USB331x"),
|
||||
};
|
||||
|
||||
int ulpi_init(void __iomem *view)
|
||||
{
|
||||
int i, vid, pid, ret;
|
||||
uint32_t ulpi_id = 0;
|
||||
|
||||
for (i = 0; i < 4; i++) {
|
||||
ret = ulpi_read(ULPI_PID_HIGH - i, view);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
ulpi_id = (ulpi_id << 8) | ret;
|
||||
}
|
||||
vid = ulpi_id & 0xffff;
|
||||
pid = ulpi_id >> 16;
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(ulpi_ids); i++) {
|
||||
if (ulpi_ids[i].id == ULPI_ID(vid, pid)) {
|
||||
pr_info("Found %s ULPI transceiver (0x%04x:0x%04x).\n",
|
||||
ulpi_ids[i].name, vid, pid);
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
pr_err("No ULPI found.\n");
|
||||
|
||||
return -1;
|
||||
}
|
||||
EXPORT_SYMBOL(ulpi_init);
|
||||
|
|
|
@ -4,6 +4,7 @@
|
|||
int ulpi_set(u8 bits, int reg, void __iomem *view);
|
||||
int ulpi_clear(u8 bits, int reg, void __iomem *view);
|
||||
int ulpi_read(int reg, void __iomem *view);
|
||||
int ulpi_init(void __iomem *view);
|
||||
|
||||
/* ULPI register addresses */
|
||||
#define ULPI_VID_LOW 0x00 /* Vendor ID low */
|
||||
|
|
Loading…
Reference in New Issue