firewire: ohci: TSB41BA3D support tweaks
Fix: phy_reg_mutex must be held over the write/read_phy_reg pair which gets PHY port status. Only print to the log when a TSB41BA3D was found. By far most TSB82AA2 cards have a TSB81BA3, and firewire-ohci can keep quiet about that. Shorten some strings and comments. Change some whitespace. Signed-off-by: Stefan Richter <stefanr@s5r6.in-berlin.de>
This commit is contained in:
parent
25935ebebd
commit
28897fb73c
@ -325,7 +325,7 @@ MODULE_PARM_DESC(quirks, "Chip quirks (default = 0"
|
|||||||
", AR/selfID endianess = " __stringify(QUIRK_BE_HEADERS)
|
", AR/selfID endianess = " __stringify(QUIRK_BE_HEADERS)
|
||||||
", no 1394a enhancements = " __stringify(QUIRK_NO_1394A)
|
", no 1394a enhancements = " __stringify(QUIRK_NO_1394A)
|
||||||
", disable MSI = " __stringify(QUIRK_NO_MSI)
|
", disable MSI = " __stringify(QUIRK_NO_MSI)
|
||||||
", workaround for TI SLLZ059 errata = " __stringify(QUIRK_TI_SLLZ059)
|
", TI SLLZ059 erratum = " __stringify(QUIRK_TI_SLLZ059)
|
||||||
")");
|
")");
|
||||||
|
|
||||||
#define OHCI_PARAM_DEBUG_AT_AR 1
|
#define OHCI_PARAM_DEBUG_AT_AR 1
|
||||||
@ -1730,12 +1730,8 @@ static int get_status_for_port(struct fw_ohci *ohci, int port_index)
|
|||||||
|
|
||||||
mutex_lock(&ohci->phy_reg_mutex);
|
mutex_lock(&ohci->phy_reg_mutex);
|
||||||
reg = write_phy_reg(ohci, 7, port_index);
|
reg = write_phy_reg(ohci, 7, port_index);
|
||||||
mutex_unlock(&ohci->phy_reg_mutex);
|
if (reg >= 0)
|
||||||
if (reg < 0)
|
reg = read_phy_reg(ohci, 8);
|
||||||
return reg;
|
|
||||||
|
|
||||||
mutex_lock(&ohci->phy_reg_mutex);
|
|
||||||
reg = read_phy_reg(ohci, 8);
|
|
||||||
mutex_unlock(&ohci->phy_reg_mutex);
|
mutex_unlock(&ohci->phy_reg_mutex);
|
||||||
if (reg < 0)
|
if (reg < 0)
|
||||||
return reg;
|
return reg;
|
||||||
@ -1754,6 +1750,7 @@ static int get_self_id_pos(struct fw_ohci *ohci, u32 self_id,
|
|||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
u32 entry;
|
u32 entry;
|
||||||
|
|
||||||
for (i = 0; i < self_id_count; i++) {
|
for (i = 0; i < self_id_count; i++) {
|
||||||
entry = ohci->self_id_buffer[i];
|
entry = ohci->self_id_buffer[i];
|
||||||
if ((self_id & 0xff000000) == (entry & 0xff000000))
|
if ((self_id & 0xff000000) == (entry & 0xff000000))
|
||||||
@ -1765,33 +1762,16 @@ static int get_self_id_pos(struct fw_ohci *ohci, u32 self_id,
|
|||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* This function implements a work around for the Texas Instruments PHY
|
* TI TSB82AA2B and TSB12LV26 do not receive the selfID of a locally
|
||||||
* TSB41BA3D. This phy has a bug at least in combination with the TI
|
* attached TSB41BA3D phy; see http://www.ti.com/litv/pdf/sllz059.
|
||||||
* LLCs TSB82AA2B and TSB12LV26. The selfid coming from the locally
|
* Construct the selfID from phy register contents.
|
||||||
* connected phy is not propagated into the selfid buffer of the OHCI
|
* FIXME: How to determine the selfID.i flag?
|
||||||
* (see http://www.ti.com/litv/pdf/sllz059 for details).
|
|
||||||
* The main idea is to construct the selfid ourselves.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
static int find_and_insert_self_id(struct fw_ohci *ohci, int self_id_count)
|
static int find_and_insert_self_id(struct fw_ohci *ohci, int self_id_count)
|
||||||
{
|
{
|
||||||
int reg;
|
int reg, i, pos, status;
|
||||||
int i;
|
/* link active 1, speed 3, bridge 0, contender 1, more packets 0 */
|
||||||
int pos;
|
u32 self_id = 0x8040c800;
|
||||||
int status;
|
|
||||||
u32 self_id;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* preset bits in self_id
|
|
||||||
*
|
|
||||||
* link active: 0b1
|
|
||||||
* speed: 0b11
|
|
||||||
* bridge: 0b00
|
|
||||||
* contender: 0b1
|
|
||||||
* initiated reset: 0b0
|
|
||||||
* more packets: 0b0
|
|
||||||
*/
|
|
||||||
self_id = 0x8040C800;
|
|
||||||
|
|
||||||
reg = reg_read(ohci, OHCI1394_NodeID);
|
reg = reg_read(ohci, OHCI1394_NodeID);
|
||||||
if (!(reg & OHCI1394_NodeID_idValid)) {
|
if (!(reg & OHCI1394_NodeID_idValid)) {
|
||||||
@ -1800,16 +1780,12 @@ static int find_and_insert_self_id(struct fw_ohci *ohci, int self_id_count)
|
|||||||
}
|
}
|
||||||
self_id |= ((reg & 0x3f) << 24); /* phy ID */
|
self_id |= ((reg & 0x3f) << 24); /* phy ID */
|
||||||
|
|
||||||
mutex_lock(&ohci->phy_reg_mutex);
|
reg = ohci_read_phy_reg(&ohci->card, 4);
|
||||||
reg = read_phy_reg(ohci, 4);
|
|
||||||
mutex_unlock(&ohci->phy_reg_mutex);
|
|
||||||
if (reg < 0)
|
if (reg < 0)
|
||||||
return reg;
|
return reg;
|
||||||
self_id |= ((reg & 0x07) << 8); /* power class */
|
self_id |= ((reg & 0x07) << 8); /* power class */
|
||||||
|
|
||||||
mutex_lock(&ohci->phy_reg_mutex);
|
reg = ohci_read_phy_reg(&ohci->card, 1);
|
||||||
reg = read_phy_reg(ohci, 1);
|
|
||||||
mutex_unlock(&ohci->phy_reg_mutex);
|
|
||||||
if (reg < 0)
|
if (reg < 0)
|
||||||
return reg;
|
return reg;
|
||||||
self_id |= ((reg & 0x3f) << 16); /* gap count */
|
self_id |= ((reg & 0x3f) << 16); /* gap count */
|
||||||
@ -1894,7 +1870,7 @@ static void bus_reset_work(struct work_struct *work)
|
|||||||
if (ohci->quirks & QUIRK_TI_SLLZ059) {
|
if (ohci->quirks & QUIRK_TI_SLLZ059) {
|
||||||
self_id_count = find_and_insert_self_id(ohci, self_id_count);
|
self_id_count = find_and_insert_self_id(ohci, self_id_count);
|
||||||
if (self_id_count < 0) {
|
if (self_id_count < 0) {
|
||||||
fw_notify("could not construct local self IDs\n");
|
fw_notify("could not construct local self ID\n");
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@ -2188,10 +2164,7 @@ static int configure_1394a_enhancements(struct fw_ohci *ohci)
|
|||||||
|
|
||||||
static int probe_tsb41ba3d(struct fw_ohci *ohci)
|
static int probe_tsb41ba3d(struct fw_ohci *ohci)
|
||||||
{
|
{
|
||||||
int reg;
|
int reg, i, vendor_id, product_id;
|
||||||
int i;
|
|
||||||
int vendor_id;
|
|
||||||
int product_id;
|
|
||||||
|
|
||||||
reg = read_phy_reg(ohci, 2);
|
reg = read_phy_reg(ohci, 2);
|
||||||
if (reg < 0)
|
if (reg < 0)
|
||||||
@ -2214,7 +2187,7 @@ static int probe_tsb41ba3d(struct fw_ohci *ohci)
|
|||||||
}
|
}
|
||||||
|
|
||||||
if ((vendor_id == TSB41BA3D_VID) &&
|
if ((vendor_id == TSB41BA3D_VID) &&
|
||||||
(product_id == TSB41BA3D_PID))
|
(product_id == TSB41BA3D_PID))
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
return 0;
|
return 0;
|
||||||
@ -2226,7 +2199,7 @@ static int ohci_enable(struct fw_card *card,
|
|||||||
struct fw_ohci *ohci = fw_ohci(card);
|
struct fw_ohci *ohci = fw_ohci(card);
|
||||||
struct pci_dev *dev = to_pci_dev(card->device);
|
struct pci_dev *dev = to_pci_dev(card->device);
|
||||||
u32 lps, seconds, version, irqs;
|
u32 lps, seconds, version, irqs;
|
||||||
int i, ret, tsb41ba3d_found;
|
int i, ret;
|
||||||
|
|
||||||
if (software_reset(ohci)) {
|
if (software_reset(ohci)) {
|
||||||
fw_error("Failed to reset ohci card.\n");
|
fw_error("Failed to reset ohci card.\n");
|
||||||
@ -2258,14 +2231,13 @@ static int ohci_enable(struct fw_card *card,
|
|||||||
}
|
}
|
||||||
|
|
||||||
if (ohci->quirks & QUIRK_TI_SLLZ059) {
|
if (ohci->quirks & QUIRK_TI_SLLZ059) {
|
||||||
tsb41ba3d_found = probe_tsb41ba3d(ohci);
|
ret = probe_tsb41ba3d(ohci);
|
||||||
if (tsb41ba3d_found < 0)
|
if (ret < 0)
|
||||||
return tsb41ba3d_found;
|
return ret;
|
||||||
if (!tsb41ba3d_found) {
|
if (ret)
|
||||||
fw_notify("No TSB41BA3D found, "
|
fw_notify("local TSB41BA3D phy\n");
|
||||||
"resetting QUIRK_TI_SLLZ059\n");
|
else
|
||||||
ohci->quirks &= ~QUIRK_TI_SLLZ059;
|
ohci->quirks &= ~QUIRK_TI_SLLZ059;
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
reg_write(ohci, OHCI1394_HCControlClear,
|
reg_write(ohci, OHCI1394_HCControlClear,
|
||||||
|
Loading…
Reference in New Issue
Block a user