|
|
|
|
@@ -267,8 +267,10 @@ static int sdw_transfer_unlocked(struct sdw_bus *bus, struct sdw_msg *msg)
|
|
|
|
|
|
|
|
|
|
ret = do_transfer(bus, msg);
|
|
|
|
|
if (ret != 0 && ret != -ENODATA)
|
|
|
|
|
dev_err(bus->dev, "trf on Slave %d failed:%d\n",
|
|
|
|
|
msg->dev_num, ret);
|
|
|
|
|
dev_err(bus->dev, "trf on Slave %d failed:%d %s addr %x count %d\n",
|
|
|
|
|
msg->dev_num, ret,
|
|
|
|
|
(msg->flags & SDW_MSG_FLAG_WRITE) ? "write" : "read",
|
|
|
|
|
msg->addr, msg->len);
|
|
|
|
|
|
|
|
|
|
if (msg->page)
|
|
|
|
|
sdw_reset_page(bus, msg->dev_num);
|
|
|
|
|
@@ -405,10 +407,11 @@ sdw_nwrite_no_pm(struct sdw_slave *slave, u32 addr, size_t count, u8 *val)
|
|
|
|
|
return sdw_transfer(slave->bus, &msg);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int sdw_write_no_pm(struct sdw_slave *slave, u32 addr, u8 value)
|
|
|
|
|
int sdw_write_no_pm(struct sdw_slave *slave, u32 addr, u8 value)
|
|
|
|
|
{
|
|
|
|
|
return sdw_nwrite_no_pm(slave, addr, 1, &value);
|
|
|
|
|
}
|
|
|
|
|
EXPORT_SYMBOL(sdw_write_no_pm);
|
|
|
|
|
|
|
|
|
|
static int
|
|
|
|
|
sdw_bread_no_pm(struct sdw_bus *bus, u16 dev_num, u32 addr)
|
|
|
|
|
@@ -476,8 +479,7 @@ int sdw_bwrite_no_pm_unlocked(struct sdw_bus *bus, u16 dev_num, u32 addr, u8 val
|
|
|
|
|
}
|
|
|
|
|
EXPORT_SYMBOL(sdw_bwrite_no_pm_unlocked);
|
|
|
|
|
|
|
|
|
|
static int
|
|
|
|
|
sdw_read_no_pm(struct sdw_slave *slave, u32 addr)
|
|
|
|
|
int sdw_read_no_pm(struct sdw_slave *slave, u32 addr)
|
|
|
|
|
{
|
|
|
|
|
u8 buf;
|
|
|
|
|
int ret;
|
|
|
|
|
@@ -488,6 +490,19 @@ sdw_read_no_pm(struct sdw_slave *slave, u32 addr)
|
|
|
|
|
else
|
|
|
|
|
return buf;
|
|
|
|
|
}
|
|
|
|
|
EXPORT_SYMBOL(sdw_read_no_pm);
|
|
|
|
|
|
|
|
|
|
static int sdw_update_no_pm(struct sdw_slave *slave, u32 addr, u8 mask, u8 val)
|
|
|
|
|
{
|
|
|
|
|
int tmp;
|
|
|
|
|
|
|
|
|
|
tmp = sdw_read_no_pm(slave, addr);
|
|
|
|
|
if (tmp < 0)
|
|
|
|
|
return tmp;
|
|
|
|
|
|
|
|
|
|
tmp = (tmp & ~mask) | val;
|
|
|
|
|
return sdw_write_no_pm(slave, addr, tmp);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* sdw_nread() - Read "n" contiguous SDW Slave registers
|
|
|
|
|
@@ -500,16 +515,16 @@ int sdw_nread(struct sdw_slave *slave, u32 addr, size_t count, u8 *val)
|
|
|
|
|
{
|
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
|
|
ret = pm_runtime_get_sync(slave->bus->dev);
|
|
|
|
|
ret = pm_runtime_get_sync(&slave->dev);
|
|
|
|
|
if (ret < 0 && ret != -EACCES) {
|
|
|
|
|
pm_runtime_put_noidle(slave->bus->dev);
|
|
|
|
|
pm_runtime_put_noidle(&slave->dev);
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
ret = sdw_nread_no_pm(slave, addr, count, val);
|
|
|
|
|
|
|
|
|
|
pm_runtime_mark_last_busy(slave->bus->dev);
|
|
|
|
|
pm_runtime_put(slave->bus->dev);
|
|
|
|
|
pm_runtime_mark_last_busy(&slave->dev);
|
|
|
|
|
pm_runtime_put(&slave->dev);
|
|
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
@@ -526,16 +541,16 @@ int sdw_nwrite(struct sdw_slave *slave, u32 addr, size_t count, u8 *val)
|
|
|
|
|
{
|
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
|
|
ret = pm_runtime_get_sync(slave->bus->dev);
|
|
|
|
|
ret = pm_runtime_get_sync(&slave->dev);
|
|
|
|
|
if (ret < 0 && ret != -EACCES) {
|
|
|
|
|
pm_runtime_put_noidle(slave->bus->dev);
|
|
|
|
|
pm_runtime_put_noidle(&slave->dev);
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
ret = sdw_nwrite_no_pm(slave, addr, count, val);
|
|
|
|
|
|
|
|
|
|
pm_runtime_mark_last_busy(slave->bus->dev);
|
|
|
|
|
pm_runtime_put(slave->bus->dev);
|
|
|
|
|
pm_runtime_mark_last_busy(&slave->dev);
|
|
|
|
|
pm_runtime_put(&slave->dev);
|
|
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
@@ -623,6 +638,7 @@ static int sdw_get_device_num(struct sdw_slave *slave)
|
|
|
|
|
|
|
|
|
|
static int sdw_assign_device_num(struct sdw_slave *slave)
|
|
|
|
|
{
|
|
|
|
|
struct sdw_bus *bus = slave->bus;
|
|
|
|
|
int ret, dev_num;
|
|
|
|
|
bool new_device = false;
|
|
|
|
|
|
|
|
|
|
@@ -633,7 +649,7 @@ static int sdw_assign_device_num(struct sdw_slave *slave)
|
|
|
|
|
dev_num = sdw_get_device_num(slave);
|
|
|
|
|
mutex_unlock(&slave->bus->bus_lock);
|
|
|
|
|
if (dev_num < 0) {
|
|
|
|
|
dev_err(slave->bus->dev, "Get dev_num failed: %d\n",
|
|
|
|
|
dev_err(bus->dev, "Get dev_num failed: %d\n",
|
|
|
|
|
dev_num);
|
|
|
|
|
return dev_num;
|
|
|
|
|
}
|
|
|
|
|
@@ -646,7 +662,7 @@ static int sdw_assign_device_num(struct sdw_slave *slave)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (!new_device)
|
|
|
|
|
dev_dbg(slave->bus->dev,
|
|
|
|
|
dev_dbg(bus->dev,
|
|
|
|
|
"Slave already registered, reusing dev_num:%d\n",
|
|
|
|
|
slave->dev_num);
|
|
|
|
|
|
|
|
|
|
@@ -656,7 +672,7 @@ static int sdw_assign_device_num(struct sdw_slave *slave)
|
|
|
|
|
|
|
|
|
|
ret = sdw_write_no_pm(slave, SDW_SCP_DEVNUMBER, dev_num);
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
dev_err(&slave->dev, "Program device_num %d failed: %d\n",
|
|
|
|
|
dev_err(bus->dev, "Program device_num %d failed: %d\n",
|
|
|
|
|
dev_num, ret);
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
@@ -679,9 +695,8 @@ void sdw_extract_slave_id(struct sdw_bus *bus,
|
|
|
|
|
id->class_id = SDW_CLASS_ID(addr);
|
|
|
|
|
|
|
|
|
|
dev_dbg(bus->dev,
|
|
|
|
|
"SDW Slave class_id %x, part_id %x, mfg_id %x, unique_id %x, version %x\n",
|
|
|
|
|
id->class_id, id->part_id, id->mfg_id,
|
|
|
|
|
id->unique_id, id->sdw_version);
|
|
|
|
|
"SDW Slave class_id 0x%02x, mfg_id 0x%04x, part_id 0x%04x, unique_id 0x%x, version 0x%x\n",
|
|
|
|
|
id->class_id, id->mfg_id, id->part_id, id->unique_id, id->sdw_version);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int sdw_program_device_num(struct sdw_bus *bus)
|
|
|
|
|
@@ -735,7 +750,7 @@ static int sdw_program_device_num(struct sdw_bus *bus)
|
|
|
|
|
*/
|
|
|
|
|
ret = sdw_assign_device_num(slave);
|
|
|
|
|
if (ret) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(bus->dev,
|
|
|
|
|
"Assign dev_num failed:%d\n",
|
|
|
|
|
ret);
|
|
|
|
|
return ret;
|
|
|
|
|
@@ -775,15 +790,17 @@ static int sdw_program_device_num(struct sdw_bus *bus)
|
|
|
|
|
static void sdw_modify_slave_status(struct sdw_slave *slave,
|
|
|
|
|
enum sdw_slave_status status)
|
|
|
|
|
{
|
|
|
|
|
mutex_lock(&slave->bus->bus_lock);
|
|
|
|
|
struct sdw_bus *bus = slave->bus;
|
|
|
|
|
|
|
|
|
|
dev_vdbg(&slave->dev,
|
|
|
|
|
mutex_lock(&bus->bus_lock);
|
|
|
|
|
|
|
|
|
|
dev_vdbg(bus->dev,
|
|
|
|
|
"%s: changing status slave %d status %d new status %d\n",
|
|
|
|
|
__func__, slave->dev_num, slave->status, status);
|
|
|
|
|
|
|
|
|
|
if (status == SDW_SLAVE_UNATTACHED) {
|
|
|
|
|
dev_dbg(&slave->dev,
|
|
|
|
|
"%s: initializing completion for Slave %d\n",
|
|
|
|
|
"%s: initializing enumeration and init completion for Slave %d\n",
|
|
|
|
|
__func__, slave->dev_num);
|
|
|
|
|
|
|
|
|
|
init_completion(&slave->enumeration_complete);
|
|
|
|
|
@@ -792,13 +809,13 @@ static void sdw_modify_slave_status(struct sdw_slave *slave,
|
|
|
|
|
} else if ((status == SDW_SLAVE_ATTACHED) &&
|
|
|
|
|
(slave->status == SDW_SLAVE_UNATTACHED)) {
|
|
|
|
|
dev_dbg(&slave->dev,
|
|
|
|
|
"%s: signaling completion for Slave %d\n",
|
|
|
|
|
"%s: signaling enumeration completion for Slave %d\n",
|
|
|
|
|
__func__, slave->dev_num);
|
|
|
|
|
|
|
|
|
|
complete(&slave->enumeration_complete);
|
|
|
|
|
}
|
|
|
|
|
slave->status = status;
|
|
|
|
|
mutex_unlock(&slave->bus->bus_lock);
|
|
|
|
|
mutex_unlock(&bus->bus_lock);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static enum sdw_clk_stop_mode sdw_get_clk_stop_mode(struct sdw_slave *slave)
|
|
|
|
|
@@ -950,17 +967,17 @@ int sdw_bus_prep_clk_stop(struct sdw_bus *bus)
|
|
|
|
|
simple_clk_stop = false;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (is_slave && !simple_clk_stop) {
|
|
|
|
|
/* Skip remaining clock stop preparation if no Slave is attached */
|
|
|
|
|
if (!is_slave)
|
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
|
|
if (!simple_clk_stop) {
|
|
|
|
|
ret = sdw_bus_wait_for_clk_prep_deprep(bus,
|
|
|
|
|
SDW_BROADCAST_DEV_NUM);
|
|
|
|
|
if (ret < 0)
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* Don't need to inform slaves if there is no slave attached */
|
|
|
|
|
if (!is_slave)
|
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
|
|
/* Inform slaves that prep is done */
|
|
|
|
|
list_for_each_entry(slave, &bus->slaves, node) {
|
|
|
|
|
if (!slave->dev_num)
|
|
|
|
|
@@ -1074,16 +1091,13 @@ int sdw_bus_exit_clk_stop(struct sdw_bus *bus)
|
|
|
|
|
"clk stop deprep failed:%d", ret);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (is_slave && !simple_clk_stop)
|
|
|
|
|
sdw_bus_wait_for_clk_prep_deprep(bus, SDW_BROADCAST_DEV_NUM);
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Don't need to call slave callback function if there is no slave
|
|
|
|
|
* attached
|
|
|
|
|
*/
|
|
|
|
|
/* Skip remaining clock stop de-preparation if no Slave is attached */
|
|
|
|
|
if (!is_slave)
|
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
|
|
if (!simple_clk_stop)
|
|
|
|
|
sdw_bus_wait_for_clk_prep_deprep(bus, SDW_BROADCAST_DEV_NUM);
|
|
|
|
|
|
|
|
|
|
list_for_each_entry(slave, &bus->slaves, node) {
|
|
|
|
|
if (!slave->dev_num)
|
|
|
|
|
continue;
|
|
|
|
|
@@ -1127,7 +1141,7 @@ int sdw_configure_dpn_intr(struct sdw_slave *slave,
|
|
|
|
|
|
|
|
|
|
ret = sdw_update(slave, addr, (mask | SDW_DPN_INT_PORT_READY), val);
|
|
|
|
|
if (ret < 0)
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_DPN_INTMASK write failed:%d\n", val);
|
|
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
@@ -1210,7 +1224,7 @@ static int sdw_slave_set_frequency(struct sdw_slave *slave)
|
|
|
|
|
}
|
|
|
|
|
scale_index++;
|
|
|
|
|
|
|
|
|
|
ret = sdw_write(slave, SDW_SCP_BUS_CLOCK_BASE, base);
|
|
|
|
|
ret = sdw_write_no_pm(slave, SDW_SCP_BUS_CLOCK_BASE, base);
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_SCP_BUS_CLOCK_BASE write failed:%d\n", ret);
|
|
|
|
|
@@ -1218,13 +1232,13 @@ static int sdw_slave_set_frequency(struct sdw_slave *slave)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* initialize scale for both banks */
|
|
|
|
|
ret = sdw_write(slave, SDW_SCP_BUSCLOCK_SCALE_B0, scale_index);
|
|
|
|
|
ret = sdw_write_no_pm(slave, SDW_SCP_BUSCLOCK_SCALE_B0, scale_index);
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_SCP_BUSCLOCK_SCALE_B0 write failed:%d\n", ret);
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
ret = sdw_write(slave, SDW_SCP_BUSCLOCK_SCALE_B1, scale_index);
|
|
|
|
|
ret = sdw_write_no_pm(slave, SDW_SCP_BUSCLOCK_SCALE_B1, scale_index);
|
|
|
|
|
if (ret < 0)
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_SCP_BUSCLOCK_SCALE_B1 write failed:%d\n", ret);
|
|
|
|
|
@@ -1256,9 +1270,9 @@ static int sdw_initialize_slave(struct sdw_slave *slave)
|
|
|
|
|
val = slave->prop.scp_int1_mask;
|
|
|
|
|
|
|
|
|
|
/* Enable SCP interrupts */
|
|
|
|
|
ret = sdw_update(slave, SDW_SCP_INTMASK1, val, val);
|
|
|
|
|
ret = sdw_update_no_pm(slave, SDW_SCP_INTMASK1, val, val);
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_SCP_INTMASK1 write failed:%d\n", ret);
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
@@ -1271,9 +1285,9 @@ static int sdw_initialize_slave(struct sdw_slave *slave)
|
|
|
|
|
val = prop->dp0_prop->imp_def_interrupts;
|
|
|
|
|
val |= SDW_DP0_INT_PORT_READY | SDW_DP0_INT_BRA_FAILURE;
|
|
|
|
|
|
|
|
|
|
ret = sdw_update(slave, SDW_DP0_INTMASK, val, val);
|
|
|
|
|
ret = sdw_update_no_pm(slave, SDW_DP0_INTMASK, val, val);
|
|
|
|
|
if (ret < 0)
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_DP0_INTMASK read failed:%d\n", ret);
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
@@ -1283,9 +1297,9 @@ static int sdw_handle_dp0_interrupt(struct sdw_slave *slave, u8 *slave_status)
|
|
|
|
|
u8 clear, impl_int_mask;
|
|
|
|
|
int status, status2, ret, count = 0;
|
|
|
|
|
|
|
|
|
|
status = sdw_read(slave, SDW_DP0_INT);
|
|
|
|
|
status = sdw_read_no_pm(slave, SDW_DP0_INT);
|
|
|
|
|
if (status < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_DP0_INT read failed:%d\n", status);
|
|
|
|
|
return status;
|
|
|
|
|
}
|
|
|
|
|
@@ -1322,17 +1336,17 @@ static int sdw_handle_dp0_interrupt(struct sdw_slave *slave, u8 *slave_status)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* clear the interrupts but don't touch reserved and SDCA_CASCADE fields */
|
|
|
|
|
ret = sdw_write(slave, SDW_DP0_INT, clear);
|
|
|
|
|
ret = sdw_write_no_pm(slave, SDW_DP0_INT, clear);
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_DP0_INT write failed:%d\n", ret);
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* Read DP0 interrupt again */
|
|
|
|
|
status2 = sdw_read(slave, SDW_DP0_INT);
|
|
|
|
|
status2 = sdw_read_no_pm(slave, SDW_DP0_INT);
|
|
|
|
|
if (status2 < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_DP0_INT read failed:%d\n", status2);
|
|
|
|
|
return status2;
|
|
|
|
|
}
|
|
|
|
|
@@ -1345,7 +1359,7 @@ static int sdw_handle_dp0_interrupt(struct sdw_slave *slave, u8 *slave_status)
|
|
|
|
|
} while ((status & SDW_DP0_INTERRUPTS) && (count < SDW_READ_INTR_CLEAR_RETRY));
|
|
|
|
|
|
|
|
|
|
if (count == SDW_READ_INTR_CLEAR_RETRY)
|
|
|
|
|
dev_warn(slave->bus->dev, "Reached MAX_RETRY on DP0 read\n");
|
|
|
|
|
dev_warn(&slave->dev, "Reached MAX_RETRY on DP0 read\n");
|
|
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
@@ -1361,9 +1375,9 @@ static int sdw_handle_port_interrupt(struct sdw_slave *slave,
|
|
|
|
|
return sdw_handle_dp0_interrupt(slave, slave_status);
|
|
|
|
|
|
|
|
|
|
addr = SDW_DPN_INT(port);
|
|
|
|
|
status = sdw_read(slave, addr);
|
|
|
|
|
status = sdw_read_no_pm(slave, addr);
|
|
|
|
|
if (status < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_DPN_INT read failed:%d\n", status);
|
|
|
|
|
|
|
|
|
|
return status;
|
|
|
|
|
@@ -1395,17 +1409,17 @@ static int sdw_handle_port_interrupt(struct sdw_slave *slave,
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* clear the interrupt but don't touch reserved fields */
|
|
|
|
|
ret = sdw_write(slave, addr, clear);
|
|
|
|
|
ret = sdw_write_no_pm(slave, addr, clear);
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_DPN_INT write failed:%d\n", ret);
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* Read DPN interrupt again */
|
|
|
|
|
status2 = sdw_read(slave, addr);
|
|
|
|
|
status2 = sdw_read_no_pm(slave, addr);
|
|
|
|
|
if (status2 < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_DPN_INT read failed:%d\n", status2);
|
|
|
|
|
return status2;
|
|
|
|
|
}
|
|
|
|
|
@@ -1418,7 +1432,7 @@ static int sdw_handle_port_interrupt(struct sdw_slave *slave,
|
|
|
|
|
} while ((status & SDW_DPN_INTERRUPTS) && (count < SDW_READ_INTR_CLEAR_RETRY));
|
|
|
|
|
|
|
|
|
|
if (count == SDW_READ_INTR_CLEAR_RETRY)
|
|
|
|
|
dev_warn(slave->bus->dev, "Reached MAX_RETRY on port read");
|
|
|
|
|
dev_warn(&slave->dev, "Reached MAX_RETRY on port read");
|
|
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
@@ -1440,30 +1454,30 @@ static int sdw_handle_slave_alerts(struct sdw_slave *slave)
|
|
|
|
|
ret = pm_runtime_get_sync(&slave->dev);
|
|
|
|
|
if (ret < 0 && ret != -EACCES) {
|
|
|
|
|
dev_err(&slave->dev, "Failed to resume device: %d\n", ret);
|
|
|
|
|
pm_runtime_put_noidle(slave->bus->dev);
|
|
|
|
|
pm_runtime_put_noidle(&slave->dev);
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* Read Intstat 1, Intstat 2 and Intstat 3 registers */
|
|
|
|
|
ret = sdw_read(slave, SDW_SCP_INT1);
|
|
|
|
|
ret = sdw_read_no_pm(slave, SDW_SCP_INT1);
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_SCP_INT1 read failed:%d\n", ret);
|
|
|
|
|
goto io_err;
|
|
|
|
|
}
|
|
|
|
|
buf = ret;
|
|
|
|
|
|
|
|
|
|
ret = sdw_nread(slave, SDW_SCP_INTSTAT2, 2, buf2);
|
|
|
|
|
ret = sdw_nread_no_pm(slave, SDW_SCP_INTSTAT2, 2, buf2);
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_SCP_INT2/3 read failed:%d\n", ret);
|
|
|
|
|
goto io_err;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (slave->prop.is_sdca) {
|
|
|
|
|
ret = sdw_read(slave, SDW_DP0_INT);
|
|
|
|
|
ret = sdw_read_no_pm(slave, SDW_DP0_INT);
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_DP0_INT read failed:%d\n", ret);
|
|
|
|
|
goto io_err;
|
|
|
|
|
}
|
|
|
|
|
@@ -1558,9 +1572,9 @@ static int sdw_handle_slave_alerts(struct sdw_slave *slave)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* Ack interrupt */
|
|
|
|
|
ret = sdw_write(slave, SDW_SCP_INT1, clear);
|
|
|
|
|
ret = sdw_write_no_pm(slave, SDW_SCP_INT1, clear);
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_SCP_INT1 write failed:%d\n", ret);
|
|
|
|
|
goto io_err;
|
|
|
|
|
}
|
|
|
|
|
@@ -1572,25 +1586,25 @@ static int sdw_handle_slave_alerts(struct sdw_slave *slave)
|
|
|
|
|
* Read status again to ensure no new interrupts arrived
|
|
|
|
|
* while servicing interrupts.
|
|
|
|
|
*/
|
|
|
|
|
ret = sdw_read(slave, SDW_SCP_INT1);
|
|
|
|
|
ret = sdw_read_no_pm(slave, SDW_SCP_INT1);
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_SCP_INT1 read failed:%d\n", ret);
|
|
|
|
|
goto io_err;
|
|
|
|
|
}
|
|
|
|
|
_buf = ret;
|
|
|
|
|
|
|
|
|
|
ret = sdw_nread(slave, SDW_SCP_INTSTAT2, 2, _buf2);
|
|
|
|
|
ret = sdw_nread_no_pm(slave, SDW_SCP_INTSTAT2, 2, _buf2);
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_SCP_INT2/3 read failed:%d\n", ret);
|
|
|
|
|
goto io_err;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (slave->prop.is_sdca) {
|
|
|
|
|
ret = sdw_read(slave, SDW_DP0_INT);
|
|
|
|
|
ret = sdw_read_no_pm(slave, SDW_DP0_INT);
|
|
|
|
|
if (ret < 0) {
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"SDW_DP0_INT read failed:%d\n", ret);
|
|
|
|
|
goto io_err;
|
|
|
|
|
}
|
|
|
|
|
@@ -1616,7 +1630,7 @@ static int sdw_handle_slave_alerts(struct sdw_slave *slave)
|
|
|
|
|
} while (stat != 0 && count < SDW_READ_INTR_CLEAR_RETRY);
|
|
|
|
|
|
|
|
|
|
if (count == SDW_READ_INTR_CLEAR_RETRY)
|
|
|
|
|
dev_warn(slave->bus->dev, "Reached MAX_RETRY on alert read\n");
|
|
|
|
|
dev_warn(&slave->dev, "Reached MAX_RETRY on alert read\n");
|
|
|
|
|
|
|
|
|
|
io_err:
|
|
|
|
|
pm_runtime_mark_last_busy(&slave->dev);
|
|
|
|
|
@@ -1722,7 +1736,7 @@ int sdw_handle_slave_status(struct sdw_bus *bus,
|
|
|
|
|
case SDW_SLAVE_ALERT:
|
|
|
|
|
ret = sdw_handle_slave_alerts(slave);
|
|
|
|
|
if (ret)
|
|
|
|
|
dev_err(bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"Slave %d alert handling failed: %d\n",
|
|
|
|
|
i, ret);
|
|
|
|
|
break;
|
|
|
|
|
@@ -1741,24 +1755,29 @@ int sdw_handle_slave_status(struct sdw_bus *bus,
|
|
|
|
|
|
|
|
|
|
ret = sdw_initialize_slave(slave);
|
|
|
|
|
if (ret)
|
|
|
|
|
dev_err(bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"Slave %d initialization failed: %d\n",
|
|
|
|
|
i, ret);
|
|
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
default:
|
|
|
|
|
dev_err(bus->dev, "Invalid slave %d status:%d\n",
|
|
|
|
|
dev_err(&slave->dev, "Invalid slave %d status:%d\n",
|
|
|
|
|
i, status[i]);
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
ret = sdw_update_slave_status(slave, status[i]);
|
|
|
|
|
if (ret)
|
|
|
|
|
dev_err(slave->bus->dev,
|
|
|
|
|
dev_err(&slave->dev,
|
|
|
|
|
"Update Slave status failed:%d\n", ret);
|
|
|
|
|
if (attached_initializing)
|
|
|
|
|
if (attached_initializing) {
|
|
|
|
|
dev_dbg(&slave->dev,
|
|
|
|
|
"%s: signaling initialization completion for Slave %d\n",
|
|
|
|
|
__func__, slave->dev_num);
|
|
|
|
|
|
|
|
|
|
complete(&slave->initialization_complete);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
|