static irqreturn_t cp_idpram_irq_handler(int irq, void *data)
{
struct dpram_link_device *dpld = (struct dpram_link_device *)data;
struct link_device *ld = (struct link_device *)&dpld->ld;
u16 int2ap;
if (unlikely(ld->mode == LINK_MODE_OFFLINE))
return IRQ_HANDLED;
if (dpram_wake_up(dpld) < 0) {
log_dpram_status(dpld);
trigger_force_cp_crash(dpld);
return IRQ_HANDLED;
}
int2ap = recv_intr(dpld);
dpram_intr_handler(dpld, int2ap);
clear_intr(dpld);
dpram_allow_sleep(dpld);
return IRQ_HANDLED;
}
static irqreturn_t dpram_irq_handler(int irq, void *data)
{
struct dpram_link_device *dpld = (struct dpram_link_device *)data;
struct link_device *ld = (struct link_device *)&dpld->ld;
u16 int2ap = 0;
if (unlikely(ld->mode == LINK_MODE_OFFLINE))
return IRQ_HANDLED;
if (dpram_wake_up(dpld) < 0) {
log_dpram_status(dpld);
trigger_force_cp_crash(dpld);
return IRQ_HANDLED;
}
int2ap = recv_intr(dpld);
if (unlikely(int2ap == INT_POWERSAFE_FAIL)) {
mif_info("%s: int2ap == INT_POWERSAFE_FAIL\n", ld->name);
goto exit;
} else if (int2ap == 0x1234 || int2ap == 0xDBAB || int2ap == 0xABCD) {
if (dpld->ext_op && dpld->ext_op->dload_cmd_handler) {
dpld->ext_op->dload_cmd_handler(dpld, int2ap);
goto exit;
}
}
if (unlikely(EXT_UDL_CMD(int2ap))) {
if (likely(EXT_INT_VALID(int2ap))) {
if (UDL_CMD_VALID(int2ap))
udl_command_handler(dpld, int2ap);
else if (EXT_CMD_VALID(int2ap))
ext_command_handler(dpld, int2ap);
else
mif_info("%s: ERR! invalid intr 0x%04X\n",
ld->name, int2ap);
} else {
mif_info("%s: ERR! invalid intr 0x%04X\n",
ld->name, int2ap);
}
} else {
if (likely(INT_VALID(int2ap))) {
if (unlikely(INT_CMD_VALID(int2ap)))
command_handler(dpld, int2ap);
else
non_command_handler(dpld, int2ap);
} else {
mif_info("%s: ERR! invalid intr 0x%04X\n",
ld->name, int2ap);
}
}
exit:
clear_intr(dpld);
dpram_allow_sleep(dpld);
return IRQ_HANDLED;
}
/*
** Functions for debugging
*/
static inline void log_dpram_status(struct dpram_link_device *dpld)
{
pr_info("mif: %s: {M:0x%X A:%d} {FMT TI:%u TO:%u RI:%u RO:%u} "
"{RAW TI:%u TO:%u RI:%u RO:%u} {INT:0x%X}\n",
dpld->ld.mc->name,
get_magic(dpld), get_access(dpld),
get_tx_head(dpld, IPC_FMT), get_tx_tail(dpld, IPC_FMT),
get_rx_head(dpld, IPC_FMT), get_rx_tail(dpld, IPC_FMT),
get_tx_head(dpld, IPC_RAW), get_tx_tail(dpld, IPC_RAW),
get_rx_head(dpld, IPC_RAW), get_rx_tail(dpld, IPC_RAW),
recv_intr(dpld));
}
static irqreturn_t ext_dpram_irq_handler(int irq, void *data)
{
struct dpram_link_device *dpld = (struct dpram_link_device *)data;
struct link_device *ld = (struct link_device *)&dpld->ld;
u16 int2ap = recv_intr(dpld);
if (unlikely(ld->mode == LINK_MODE_OFFLINE))
return IRQ_HANDLED;
dpram_intr_handler(dpld, int2ap);
return IRQ_HANDLED;
}
static void set_dpram_map(struct dpram_link_device *dpld,
struct mif_irq_map *map)
{
map->magic = get_magic(dpld);
map->access = get_access(dpld);
map->fmt_tx_in = get_tx_head(dpld, IPC_FMT);
map->fmt_tx_out = get_tx_tail(dpld, IPC_FMT);
map->fmt_rx_in = get_rx_head(dpld, IPC_FMT);
map->fmt_rx_out = get_rx_tail(dpld, IPC_FMT);
map->raw_tx_in = get_tx_head(dpld, IPC_RAW);
map->raw_tx_out = get_tx_tail(dpld, IPC_RAW);
map->raw_rx_in = get_rx_head(dpld, IPC_RAW);
map->raw_rx_out = get_rx_tail(dpld, IPC_RAW);
map->cp2ap = recv_intr(dpld);
}
