Commit c8a94ded authored by Stefan Richter's avatar Stefan Richter

firewire: normalize STATE_CLEAR/SET CSR access interface

Push the maintenance of STATE_CLEAR/SET.abdicate down into the card
driver.  This way, the read/write_csr_reg driver method works uniformly
across all CSR offsets.
Signed-off-by: default avatarStefan Richter <stefanr@s5r6.in-berlin.de>
parent db3c9cc1
...@@ -524,7 +524,7 @@ static void update_topology_map(struct fw_card *card, ...@@ -524,7 +524,7 @@ static void update_topology_map(struct fw_card *card,
} }
void fw_core_handle_bus_reset(struct fw_card *card, int node_id, int generation, void fw_core_handle_bus_reset(struct fw_card *card, int node_id, int generation,
int self_id_count, u32 *self_ids) int self_id_count, u32 *self_ids, bool bm_abdicate)
{ {
struct fw_node *local_node; struct fw_node *local_node;
unsigned long flags; unsigned long flags;
...@@ -552,8 +552,7 @@ void fw_core_handle_bus_reset(struct fw_card *card, int node_id, int generation, ...@@ -552,8 +552,7 @@ void fw_core_handle_bus_reset(struct fw_card *card, int node_id, int generation,
smp_wmb(); smp_wmb();
card->generation = generation; card->generation = generation;
card->reset_jiffies = jiffies; card->reset_jiffies = jiffies;
card->bm_abdicate = card->csr_abdicate; card->bm_abdicate = bm_abdicate;
card->csr_abdicate = false;
fw_schedule_bm_work(card, 0); fw_schedule_bm_work(card, 0);
local_node = build_tree(card, self_ids, self_id_count); local_node = build_tree(card, self_ids, self_id_count);
......
...@@ -982,20 +982,6 @@ static const struct fw_address_region registers_region = ...@@ -982,20 +982,6 @@ static const struct fw_address_region registers_region =
{ .start = CSR_REGISTER_BASE, { .start = CSR_REGISTER_BASE,
.end = CSR_REGISTER_BASE | CSR_CONFIG_ROM, }; .end = CSR_REGISTER_BASE | CSR_CONFIG_ROM, };
static u32 read_state_register(struct fw_card *card)
{
u32 value;
/* Bit 8 (cmstr): */
value = card->driver->read_csr_reg(card, CSR_STATE_CLEAR);
/* Bit 10 (abdicate): */
if (card->csr_abdicate)
value |= CSR_STATE_BIT_ABDICATE;
return value;
}
static void update_split_timeout(struct fw_card *card) static void update_split_timeout(struct fw_card *card)
{ {
unsigned int cycles; unsigned int cycles;
...@@ -1021,29 +1007,25 @@ static void handle_registers(struct fw_card *card, struct fw_request *request, ...@@ -1021,29 +1007,25 @@ static void handle_registers(struct fw_card *card, struct fw_request *request,
switch (reg) { switch (reg) {
case CSR_STATE_CLEAR: case CSR_STATE_CLEAR:
if (tcode == TCODE_READ_QUADLET_REQUEST) { if (tcode == TCODE_READ_QUADLET_REQUEST)
*data = cpu_to_be32(read_state_register(card)); *data = cpu_to_be32(card->driver->
} else if (tcode == TCODE_WRITE_QUADLET_REQUEST) { read_csr_reg(card, CSR_STATE_CLEAR));
else if (tcode == TCODE_WRITE_QUADLET_REQUEST)
card->driver->write_csr_reg(card, CSR_STATE_CLEAR, card->driver->write_csr_reg(card, CSR_STATE_CLEAR,
be32_to_cpu(*data)); be32_to_cpu(*data));
if (*data & cpu_to_be32(CSR_STATE_BIT_ABDICATE)) else
card->csr_abdicate = false;
} else {
rcode = RCODE_TYPE_ERROR; rcode = RCODE_TYPE_ERROR;
}
break; break;
case CSR_STATE_SET: case CSR_STATE_SET:
if (tcode == TCODE_READ_QUADLET_REQUEST) { if (tcode == TCODE_READ_QUADLET_REQUEST)
*data = cpu_to_be32(read_state_register(card)); *data = cpu_to_be32(card->driver->
} else if (tcode == TCODE_WRITE_QUADLET_REQUEST) { read_csr_reg(card, CSR_STATE_SET));
else if (tcode == TCODE_WRITE_QUADLET_REQUEST)
card->driver->write_csr_reg(card, CSR_STATE_SET, card->driver->write_csr_reg(card, CSR_STATE_SET,
be32_to_cpu(*data)); be32_to_cpu(*data));
if (*data & cpu_to_be32(CSR_STATE_BIT_ABDICATE)) else
card->csr_abdicate = true;
} else {
rcode = RCODE_TYPE_ERROR; rcode = RCODE_TYPE_ERROR;
}
break; break;
case CSR_NODE_IDS: case CSR_NODE_IDS:
...@@ -1063,7 +1045,8 @@ static void handle_registers(struct fw_card *card, struct fw_request *request, ...@@ -1063,7 +1045,8 @@ static void handle_registers(struct fw_card *card, struct fw_request *request,
case CSR_RESET_START: case CSR_RESET_START:
if (tcode == TCODE_WRITE_QUADLET_REQUEST) if (tcode == TCODE_WRITE_QUADLET_REQUEST)
card->csr_abdicate = false; card->driver->write_csr_reg(card, CSR_STATE_CLEAR,
CSR_STATE_BIT_ABDICATE);
else else
rcode = RCODE_TYPE_ERROR; rcode = RCODE_TYPE_ERROR;
break; break;
......
...@@ -196,7 +196,7 @@ static inline void fw_node_put(struct fw_node *node) ...@@ -196,7 +196,7 @@ static inline void fw_node_put(struct fw_node *node)
} }
void fw_core_handle_bus_reset(struct fw_card *card, int node_id, void fw_core_handle_bus_reset(struct fw_card *card, int node_id,
int generation, int self_id_count, u32 *self_ids); int generation, int self_id_count, u32 *self_ids, bool bm_abdicate);
void fw_destroy_nodes(struct fw_card *card); void fw_destroy_nodes(struct fw_card *card);
/* /*
......
...@@ -174,6 +174,7 @@ struct fw_ohci { ...@@ -174,6 +174,7 @@ struct fw_ohci {
unsigned int pri_req_max; unsigned int pri_req_max;
u32 bus_time; u32 bus_time;
bool is_root; bool is_root;
bool csr_state_setclear_abdicate;
/* /*
* Spinlock for accessing fw_ohci data. Never call out of * Spinlock for accessing fw_ohci data. Never call out of
...@@ -1529,7 +1530,9 @@ static void bus_reset_tasklet(unsigned long data) ...@@ -1529,7 +1530,9 @@ static void bus_reset_tasklet(unsigned long data)
self_id_count, ohci->self_id_buffer); self_id_count, ohci->self_id_buffer);
fw_core_handle_bus_reset(&ohci->card, ohci->node_id, generation, fw_core_handle_bus_reset(&ohci->card, ohci->node_id, generation,
self_id_count, ohci->self_id_buffer); self_id_count, ohci->self_id_buffer,
ohci->csr_state_setclear_abdicate);
ohci->csr_state_setclear_abdicate = false;
} }
static irqreturn_t irq_handler(int irq, void *data) static irqreturn_t irq_handler(int irq, void *data)
...@@ -2032,13 +2035,16 @@ static u32 ohci_read_csr_reg(struct fw_card *card, int csr_offset) ...@@ -2032,13 +2035,16 @@ static u32 ohci_read_csr_reg(struct fw_card *card, int csr_offset)
switch (csr_offset) { switch (csr_offset) {
case CSR_STATE_CLEAR: case CSR_STATE_CLEAR:
case CSR_STATE_SET: case CSR_STATE_SET:
/* the controller driver handles only the cmstr bit */
if (ohci->is_root && if (ohci->is_root &&
(reg_read(ohci, OHCI1394_LinkControlSet) & (reg_read(ohci, OHCI1394_LinkControlSet) &
OHCI1394_LinkControl_cycleMaster)) OHCI1394_LinkControl_cycleMaster))
return CSR_STATE_BIT_CMSTR; value = CSR_STATE_BIT_CMSTR;
else else
return 0; value = 0;
if (ohci->csr_state_setclear_abdicate)
value |= CSR_STATE_BIT_ABDICATE;
return value;
case CSR_NODE_IDS: case CSR_NODE_IDS:
return reg_read(ohci, OHCI1394_NodeID) << 16; return reg_read(ohci, OHCI1394_NodeID) << 16;
...@@ -2078,12 +2084,13 @@ static void ohci_write_csr_reg(struct fw_card *card, int csr_offset, u32 value) ...@@ -2078,12 +2084,13 @@ static void ohci_write_csr_reg(struct fw_card *card, int csr_offset, u32 value)
switch (csr_offset) { switch (csr_offset) {
case CSR_STATE_CLEAR: case CSR_STATE_CLEAR:
/* the controller driver handles only the cmstr bit */
if ((value & CSR_STATE_BIT_CMSTR) && ohci->is_root) { if ((value & CSR_STATE_BIT_CMSTR) && ohci->is_root) {
reg_write(ohci, OHCI1394_LinkControlClear, reg_write(ohci, OHCI1394_LinkControlClear,
OHCI1394_LinkControl_cycleMaster); OHCI1394_LinkControl_cycleMaster);
flush_writes(ohci); flush_writes(ohci);
} }
if (value & CSR_STATE_BIT_ABDICATE)
ohci->csr_state_setclear_abdicate = false;
break; break;
case CSR_STATE_SET: case CSR_STATE_SET:
...@@ -2092,6 +2099,8 @@ static void ohci_write_csr_reg(struct fw_card *card, int csr_offset, u32 value) ...@@ -2092,6 +2099,8 @@ static void ohci_write_csr_reg(struct fw_card *card, int csr_offset, u32 value)
OHCI1394_LinkControl_cycleMaster); OHCI1394_LinkControl_cycleMaster);
flush_writes(ohci); flush_writes(ohci);
} }
if (value & CSR_STATE_BIT_ABDICATE)
ohci->csr_state_setclear_abdicate = true;
break; break;
case CSR_NODE_IDS: case CSR_NODE_IDS:
......
...@@ -119,8 +119,7 @@ struct fw_card { ...@@ -119,8 +119,7 @@ struct fw_card {
int bm_retries; int bm_retries;
int bm_generation; int bm_generation;
__be32 bm_transaction_data[2]; __be32 bm_transaction_data[2];
bool bm_abdicate; /* value of csr_abdicate before last bus reset */ bool bm_abdicate;
bool csr_abdicate; /* visible in CSR STATE_CLEAR/SET registers */
bool priority_budget_implemented; /* controller feature */ bool priority_budget_implemented; /* controller feature */
bool broadcast_channel_auto_allocated; /* controller feature */ bool broadcast_channel_auto_allocated; /* controller feature */
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment