Lines Matching full:slave
132 * Create Slave devices based on Slaves described in in sdw_bus_master_add()
169 struct sdw_slave *slave = dev_to_sdw_dev(dev); in sdw_delete_slave() local
170 struct sdw_bus *bus = slave->bus; in sdw_delete_slave()
174 sdw_slave_debugfs_exit(slave); in sdw_delete_slave()
178 if (slave->dev_num) { /* clear dev_num if assigned */ in sdw_delete_slave()
179 clear_bit(slave->dev_num, bus->assigned); in sdw_delete_slave()
181 bus->ops->put_device_num(bus, slave); in sdw_delete_slave()
183 list_del_init(&slave->node); in sdw_delete_slave()
279 dev_err(bus->dev, "trf on Slave %d failed:%d %s addr %x count %d\n", in sdw_transfer_unlocked()
288 * sdw_transfer() - Synchronous transfer message to a SDW Slave device
338 * sdw_transfer_defer() - Asynchronously transfer message to a SDW Slave device
353 dev_err(bus->dev, "Defer trf on Slave %d failed:%d\n", in sdw_transfer_defer()
359 int sdw_fill_msg(struct sdw_msg *msg, struct sdw_slave *slave, in sdw_fill_msg() argument
378 if (slave && !slave->prop.paging_support) in sdw_fill_msg()
389 if (!slave) { in sdw_fill_msg()
390 pr_err("SDW: No slave for paging addr\n"); in sdw_fill_msg()
394 if (!slave->prop.paging_support) { in sdw_fill_msg()
395 dev_err(&slave->dev, in sdw_fill_msg()
412 static int sdw_ntransfer_no_pm(struct sdw_slave *slave, u32 addr, u8 flags, in sdw_ntransfer_no_pm() argument
423 ret = sdw_fill_msg(&msg, slave, addr, size, slave->dev_num, flags, val); in sdw_ntransfer_no_pm()
427 ret = sdw_transfer(slave->bus, &msg); in sdw_ntransfer_no_pm()
428 if (ret < 0 && !slave->is_mockup_device) in sdw_ntransfer_no_pm()
440 * sdw_nread_no_pm() - Read "n" contiguous SDW Slave registers with no PM
441 * @slave: SDW Slave
449 int sdw_nread_no_pm(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nread_no_pm() argument
451 return sdw_ntransfer_no_pm(slave, addr, SDW_MSG_FLAG_READ, count, val); in sdw_nread_no_pm()
456 * sdw_nwrite_no_pm() - Write "n" contiguous SDW Slave registers with no PM
457 * @slave: SDW Slave
465 int sdw_nwrite_no_pm(struct sdw_slave *slave, u32 addr, size_t count, const u8 *val) in sdw_nwrite_no_pm() argument
467 return sdw_ntransfer_no_pm(slave, addr, SDW_MSG_FLAG_WRITE, count, (u8 *)val); in sdw_nwrite_no_pm()
472 * sdw_write_no_pm() - Write a SDW Slave register with no PM
473 * @slave: SDW Slave
477 int sdw_write_no_pm(struct sdw_slave *slave, u32 addr, u8 value) in sdw_write_no_pm() argument
479 return sdw_nwrite_no_pm(slave, addr, 1, &value); in sdw_write_no_pm()
550 * sdw_read_no_pm() - Read a SDW Slave register with no PM
551 * @slave: SDW Slave
554 int sdw_read_no_pm(struct sdw_slave *slave, u32 addr) in sdw_read_no_pm() argument
559 ret = sdw_nread_no_pm(slave, addr, 1, &buf); in sdw_read_no_pm()
567 int sdw_update_no_pm(struct sdw_slave *slave, u32 addr, u8 mask, u8 val) in sdw_update_no_pm() argument
571 tmp = sdw_read_no_pm(slave, addr); in sdw_update_no_pm()
576 return sdw_write_no_pm(slave, addr, tmp); in sdw_update_no_pm()
580 /* Read-Modify-Write Slave register */
581 int sdw_update(struct sdw_slave *slave, u32 addr, u8 mask, u8 val) in sdw_update() argument
585 tmp = sdw_read(slave, addr); in sdw_update()
590 return sdw_write(slave, addr, tmp); in sdw_update()
595 * sdw_nread() - Read "n" contiguous SDW Slave registers
596 * @slave: SDW Slave
601 * This version of the function will take a PM reference to the slave
606 int sdw_nread(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nread() argument
610 ret = pm_runtime_get_sync(&slave->dev); in sdw_nread()
612 pm_runtime_put_noidle(&slave->dev); in sdw_nread()
616 ret = sdw_nread_no_pm(slave, addr, count, val); in sdw_nread()
618 pm_runtime_mark_last_busy(&slave->dev); in sdw_nread()
619 pm_runtime_put(&slave->dev); in sdw_nread()
626 * sdw_nwrite() - Write "n" contiguous SDW Slave registers
627 * @slave: SDW Slave
632 * This version of the function will take a PM reference to the slave
637 int sdw_nwrite(struct sdw_slave *slave, u32 addr, size_t count, const u8 *val) in sdw_nwrite() argument
641 ret = pm_runtime_get_sync(&slave->dev); in sdw_nwrite()
643 pm_runtime_put_noidle(&slave->dev); in sdw_nwrite()
647 ret = sdw_nwrite_no_pm(slave, addr, count, val); in sdw_nwrite()
649 pm_runtime_mark_last_busy(&slave->dev); in sdw_nwrite()
650 pm_runtime_put(&slave->dev); in sdw_nwrite()
657 * sdw_read() - Read a SDW Slave register
658 * @slave: SDW Slave
661 * This version of the function will take a PM reference to the slave
664 int sdw_read(struct sdw_slave *slave, u32 addr) in sdw_read() argument
669 ret = sdw_nread(slave, addr, 1, &buf); in sdw_read()
678 * sdw_write() - Write a SDW Slave register
679 * @slave: SDW Slave
683 * This version of the function will take a PM reference to the slave
686 int sdw_write(struct sdw_slave *slave, u32 addr, u8 value) in sdw_write() argument
688 return sdw_nwrite(slave, addr, 1, &value); in sdw_write()
699 struct sdw_slave *slave; in sdw_get_slave() local
701 list_for_each_entry(slave, &bus->slaves, node) { in sdw_get_slave()
702 if (slave->dev_num == i) in sdw_get_slave()
703 return slave; in sdw_get_slave()
709 int sdw_compare_devid(struct sdw_slave *slave, struct sdw_slave_id id) in sdw_compare_devid() argument
711 if (slave->id.mfg_id != id.mfg_id || in sdw_compare_devid()
712 slave->id.part_id != id.part_id || in sdw_compare_devid()
713 slave->id.class_id != id.class_id || in sdw_compare_devid()
714 (slave->id.unique_id != SDW_IGNORED_UNIQUE_ID && in sdw_compare_devid()
715 slave->id.unique_id != id.unique_id)) in sdw_compare_devid()
723 static int sdw_get_device_num(struct sdw_slave *slave) in sdw_get_device_num() argument
725 struct sdw_bus *bus = slave->bus; in sdw_get_device_num()
729 bit = bus->ops->get_device_num(bus, slave); in sdw_get_device_num()
741 * Do not update dev_num in Slave data structure here, in sdw_get_device_num()
750 static int sdw_assign_device_num(struct sdw_slave *slave) in sdw_assign_device_num() argument
752 struct sdw_bus *bus = slave->bus; in sdw_assign_device_num()
757 if (!slave->dev_num) { in sdw_assign_device_num()
758 if (!slave->dev_num_sticky) { in sdw_assign_device_num()
759 mutex_lock(&slave->bus->bus_lock); in sdw_assign_device_num()
760 dev_num = sdw_get_device_num(slave); in sdw_assign_device_num()
761 mutex_unlock(&slave->bus->bus_lock); in sdw_assign_device_num()
767 slave->dev_num = dev_num; in sdw_assign_device_num()
768 slave->dev_num_sticky = dev_num; in sdw_assign_device_num()
771 slave->dev_num = slave->dev_num_sticky; in sdw_assign_device_num()
777 "Slave already registered, reusing dev_num:%d\n", in sdw_assign_device_num()
778 slave->dev_num); in sdw_assign_device_num()
780 /* Clear the slave->dev_num to transfer message on device 0 */ in sdw_assign_device_num()
781 dev_num = slave->dev_num; in sdw_assign_device_num()
782 slave->dev_num = 0; in sdw_assign_device_num()
784 ret = sdw_write_no_pm(slave, SDW_SCP_DEVNUMBER, dev_num); in sdw_assign_device_num()
792 slave->dev_num = slave->dev_num_sticky; in sdw_assign_device_num()
795 bus->ops->new_peripheral_assigned(bus, slave, dev_num); in sdw_assign_device_num()
803 dev_dbg(bus->dev, "SDW Slave Addr: %llx\n", addr); in sdw_extract_slave_id()
812 "SDW Slave class_id 0x%02x, mfg_id 0x%04x, part_id 0x%04x, unique_id 0x%x, version 0x%x\n", in sdw_extract_slave_id()
820 struct sdw_slave *slave, *_s; in sdw_program_device_num() local
829 /* No Slave, so use raw xfer api */ in sdw_program_device_num()
859 list_for_each_entry_safe(slave, _s, &bus->slaves, node) { in sdw_program_device_num()
860 if (sdw_compare_devid(slave, id) == 0) { in sdw_program_device_num()
870 if (slave->status != SDW_SLAVE_UNATTACHED) in sdw_program_device_num()
874 * Assign a new dev_num to this Slave and in sdw_program_device_num()
879 ret = sdw_assign_device_num(slave); in sdw_program_device_num()
897 * add Slave device even if there is no platform in sdw_program_device_num()
904 dev_err(bus->dev, "Slave Entry not found\n"); in sdw_program_device_num()
920 static void sdw_modify_slave_status(struct sdw_slave *slave, in sdw_modify_slave_status() argument
923 struct sdw_bus *bus = slave->bus; in sdw_modify_slave_status()
928 "changing status slave %d status %d new status %d\n", in sdw_modify_slave_status()
929 slave->dev_num, slave->status, status); in sdw_modify_slave_status()
932 dev_dbg(&slave->dev, in sdw_modify_slave_status()
933 "initializing enumeration and init completion for Slave %d\n", in sdw_modify_slave_status()
934 slave->dev_num); in sdw_modify_slave_status()
936 reinit_completion(&slave->enumeration_complete); in sdw_modify_slave_status()
937 reinit_completion(&slave->initialization_complete); in sdw_modify_slave_status()
940 (slave->status == SDW_SLAVE_UNATTACHED)) { in sdw_modify_slave_status()
941 dev_dbg(&slave->dev, in sdw_modify_slave_status()
942 "signaling enumeration completion for Slave %d\n", in sdw_modify_slave_status()
943 slave->dev_num); in sdw_modify_slave_status()
945 complete_all(&slave->enumeration_complete); in sdw_modify_slave_status()
947 slave->status = status; in sdw_modify_slave_status()
951 static int sdw_slave_clk_stop_callback(struct sdw_slave *slave, in sdw_slave_clk_stop_callback() argument
957 mutex_lock(&slave->sdw_dev_lock); in sdw_slave_clk_stop_callback()
959 if (slave->probed) { in sdw_slave_clk_stop_callback()
960 struct device *dev = &slave->dev; in sdw_slave_clk_stop_callback()
964 ret = drv->ops->clk_stop(slave, mode, type); in sdw_slave_clk_stop_callback()
967 mutex_unlock(&slave->sdw_dev_lock); in sdw_slave_clk_stop_callback()
972 static int sdw_slave_clk_stop_prepare(struct sdw_slave *slave, in sdw_slave_clk_stop_prepare() argument
980 wake_en = slave->prop.wake_capable; in sdw_slave_clk_stop_prepare()
991 ret = sdw_read_no_pm(slave, SDW_SCP_SYSTEMCTRL); in sdw_slave_clk_stop_prepare()
994 dev_err(&slave->dev, "SDW_SCP_SYSTEMCTRL read failed:%d\n", ret); in sdw_slave_clk_stop_prepare()
1001 ret = sdw_write_no_pm(slave, SDW_SCP_SYSTEMCTRL, val); in sdw_slave_clk_stop_prepare()
1004 dev_err(&slave->dev, "SDW_SCP_SYSTEMCTRL write failed:%d\n", ret); in sdw_slave_clk_stop_prepare()
1023 dev_dbg(bus->dev, "clock stop prep/de-prep done slave:%d\n", in sdw_bus_wait_for_clk_prep_deprep()
1032 dev_err(bus->dev, "clock stop prep/de-prep failed slave:%d\n", in sdw_bus_wait_for_clk_prep_deprep()
1039 * sdw_bus_prep_clk_stop: prepare Slave(s) for clock stop
1043 * Query Slave for clock stop mode and prepare for that mode.
1048 struct sdw_slave *slave; in sdw_bus_prep_clk_stop() local
1054 * each Slave and then wait for all Slave(s) to be in sdw_bus_prep_clk_stop()
1056 * If one of the Slave devices has lost sync and in sdw_bus_prep_clk_stop()
1060 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_prep_clk_stop()
1061 if (!slave->dev_num) in sdw_bus_prep_clk_stop()
1064 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_prep_clk_stop()
1065 slave->status != SDW_SLAVE_ALERT) in sdw_bus_prep_clk_stop()
1068 /* Identify if Slave(s) are available on Bus */ in sdw_bus_prep_clk_stop()
1071 ret = sdw_slave_clk_stop_callback(slave, in sdw_bus_prep_clk_stop()
1075 dev_err(&slave->dev, "clock stop pre-prepare cb failed:%d\n", ret); in sdw_bus_prep_clk_stop()
1079 /* Only prepare a Slave device if needed */ in sdw_bus_prep_clk_stop()
1080 if (!slave->prop.simple_clk_stop_capable) { in sdw_bus_prep_clk_stop()
1083 ret = sdw_slave_clk_stop_prepare(slave, in sdw_bus_prep_clk_stop()
1087 dev_err(&slave->dev, "clock stop prepare failed:%d\n", ret); in sdw_bus_prep_clk_stop()
1093 /* Skip remaining clock stop preparation if no Slave is attached */ in sdw_bus_prep_clk_stop()
1105 * if there are no Slave devices present and the reply is in sdw_bus_prep_clk_stop()
1115 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_prep_clk_stop()
1116 if (!slave->dev_num) in sdw_bus_prep_clk_stop()
1119 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_prep_clk_stop()
1120 slave->status != SDW_SLAVE_ALERT) in sdw_bus_prep_clk_stop()
1123 ret = sdw_slave_clk_stop_callback(slave, in sdw_bus_prep_clk_stop()
1128 dev_err(&slave->dev, "clock stop post-prepare cb failed:%d\n", ret); in sdw_bus_prep_clk_stop()
1177 struct sdw_slave *slave; in sdw_bus_exit_clk_stop() local
1183 * each Slave and then wait for all Slave(s) to be in sdw_bus_exit_clk_stop()
1186 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_exit_clk_stop()
1187 if (!slave->dev_num) in sdw_bus_exit_clk_stop()
1190 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_exit_clk_stop()
1191 slave->status != SDW_SLAVE_ALERT) in sdw_bus_exit_clk_stop()
1194 /* Identify if Slave(s) are available on Bus */ in sdw_bus_exit_clk_stop()
1197 ret = sdw_slave_clk_stop_callback(slave, SDW_CLK_STOP_MODE0, in sdw_bus_exit_clk_stop()
1200 dev_warn(&slave->dev, "clock stop pre-deprepare cb failed:%d\n", ret); in sdw_bus_exit_clk_stop()
1202 /* Only de-prepare a Slave device if needed */ in sdw_bus_exit_clk_stop()
1203 if (!slave->prop.simple_clk_stop_capable) { in sdw_bus_exit_clk_stop()
1206 ret = sdw_slave_clk_stop_prepare(slave, SDW_CLK_STOP_MODE0, in sdw_bus_exit_clk_stop()
1210 dev_warn(&slave->dev, "clock stop deprepare failed:%d\n", ret); in sdw_bus_exit_clk_stop()
1214 /* Skip remaining clock stop de-preparation if no Slave is attached */ in sdw_bus_exit_clk_stop()
1228 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_exit_clk_stop()
1229 if (!slave->dev_num) in sdw_bus_exit_clk_stop()
1232 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_exit_clk_stop()
1233 slave->status != SDW_SLAVE_ALERT) in sdw_bus_exit_clk_stop()
1236 ret = sdw_slave_clk_stop_callback(slave, SDW_CLK_STOP_MODE0, in sdw_bus_exit_clk_stop()
1239 dev_warn(&slave->dev, "clock stop post-deprepare cb failed:%d\n", ret); in sdw_bus_exit_clk_stop()
1246 int sdw_configure_dpn_intr(struct sdw_slave *slave, in sdw_configure_dpn_intr() argument
1253 if (slave->bus->params.s_data_mode != SDW_PORT_DATA_MODE_NORMAL) { in sdw_configure_dpn_intr()
1254 dev_dbg(&slave->dev, "TEST FAIL interrupt %s\n", in sdw_configure_dpn_intr()
1270 ret = sdw_update_no_pm(slave, addr, (mask | SDW_DPN_INT_PORT_READY), val); in sdw_configure_dpn_intr()
1272 dev_err(&slave->dev, in sdw_configure_dpn_intr()
1278 static int sdw_slave_set_frequency(struct sdw_slave *slave) in sdw_slave_set_frequency() argument
1280 u32 mclk_freq = slave->bus->prop.mclk_freq; in sdw_slave_set_frequency()
1281 u32 curr_freq = slave->bus->params.curr_dr_freq >> 1; in sdw_slave_set_frequency()
1293 if (!slave->id.class_id && !slave->prop.clock_reg_supported) in sdw_slave_set_frequency()
1297 dev_err(&slave->dev, in sdw_slave_set_frequency()
1327 dev_err(&slave->dev, in sdw_slave_set_frequency()
1334 dev_err(&slave->dev, in sdw_slave_set_frequency()
1349 dev_err(&slave->dev, in sdw_slave_set_frequency()
1356 ret = sdw_write_no_pm(slave, SDW_SCP_BUS_CLOCK_BASE, base); in sdw_slave_set_frequency()
1358 dev_err(&slave->dev, in sdw_slave_set_frequency()
1364 ret = sdw_write_no_pm(slave, SDW_SCP_BUSCLOCK_SCALE_B0, scale_index); in sdw_slave_set_frequency()
1366 dev_err(&slave->dev, in sdw_slave_set_frequency()
1370 ret = sdw_write_no_pm(slave, SDW_SCP_BUSCLOCK_SCALE_B1, scale_index); in sdw_slave_set_frequency()
1372 dev_err(&slave->dev, in sdw_slave_set_frequency()
1375 dev_dbg(&slave->dev, in sdw_slave_set_frequency()
1382 static int sdw_initialize_slave(struct sdw_slave *slave) in sdw_initialize_slave() argument
1384 struct sdw_slave_prop *prop = &slave->prop; in sdw_initialize_slave()
1389 ret = sdw_slave_set_frequency(slave); in sdw_initialize_slave()
1393 if (slave->bus->prop.quirks & SDW_MASTER_QUIRKS_CLEAR_INITIAL_CLASH) { in sdw_initialize_slave()
1395 status = sdw_read_no_pm(slave, SDW_SCP_INT1); in sdw_initialize_slave()
1397 dev_err(&slave->dev, in sdw_initialize_slave()
1402 dev_warn(&slave->dev, "Bus clash detected before INT mask is enabled\n"); in sdw_initialize_slave()
1403 ret = sdw_write_no_pm(slave, SDW_SCP_INT1, SDW_SCP_INT1_BUS_CLASH); in sdw_initialize_slave()
1405 dev_err(&slave->dev, in sdw_initialize_slave()
1411 if ((slave->bus->prop.quirks & SDW_MASTER_QUIRKS_CLEAR_INITIAL_PARITY) && in sdw_initialize_slave()
1412 !(slave->prop.quirks & SDW_SLAVE_QUIRKS_INVALID_INITIAL_PARITY)) { in sdw_initialize_slave()
1414 status = sdw_read_no_pm(slave, SDW_SCP_INT1); in sdw_initialize_slave()
1416 dev_err(&slave->dev, in sdw_initialize_slave()
1421 dev_warn(&slave->dev, "PARITY error detected before INT mask is enabled\n"); in sdw_initialize_slave()
1422 ret = sdw_write_no_pm(slave, SDW_SCP_INT1, SDW_SCP_INT1_PARITY); in sdw_initialize_slave()
1424 dev_err(&slave->dev, in sdw_initialize_slave()
1438 val = slave->prop.scp_int1_mask; in sdw_initialize_slave()
1441 ret = sdw_update_no_pm(slave, SDW_SCP_INTMASK1, val, val); in sdw_initialize_slave()
1443 dev_err(&slave->dev, in sdw_initialize_slave()
1449 if (!slave->prop.dp0_prop) in sdw_initialize_slave()
1456 ret = sdw_update_no_pm(slave, SDW_DP0_INTMASK, val, val); in sdw_initialize_slave()
1458 dev_err(&slave->dev, in sdw_initialize_slave()
1463 static int sdw_handle_dp0_interrupt(struct sdw_slave *slave, u8 *slave_status) in sdw_handle_dp0_interrupt() argument
1468 status = sdw_read_no_pm(slave, SDW_DP0_INT); in sdw_handle_dp0_interrupt()
1470 dev_err(&slave->dev, in sdw_handle_dp0_interrupt()
1479 dev_err(&slave->dev, "Test fail for port 0\n"); in sdw_handle_dp0_interrupt()
1489 complete(&slave->port_ready[0]); in sdw_handle_dp0_interrupt()
1494 dev_err(&slave->dev, "BRA failed\n"); in sdw_handle_dp0_interrupt()
1507 ret = sdw_write_no_pm(slave, SDW_DP0_INT, clear); in sdw_handle_dp0_interrupt()
1509 dev_err(&slave->dev, in sdw_handle_dp0_interrupt()
1515 status2 = sdw_read_no_pm(slave, SDW_DP0_INT); in sdw_handle_dp0_interrupt()
1517 dev_err(&slave->dev, in sdw_handle_dp0_interrupt()
1530 dev_warn(&slave->dev, "Reached MAX_RETRY on DP0 read\n"); in sdw_handle_dp0_interrupt()
1535 static int sdw_handle_port_interrupt(struct sdw_slave *slave, in sdw_handle_port_interrupt() argument
1543 return sdw_handle_dp0_interrupt(slave, slave_status); in sdw_handle_port_interrupt()
1546 status = sdw_read_no_pm(slave, addr); in sdw_handle_port_interrupt()
1548 dev_err(&slave->dev, in sdw_handle_port_interrupt()
1558 dev_err(&slave->dev, "Test fail for port:%d\n", port); in sdw_handle_port_interrupt()
1567 complete(&slave->port_ready[port]); in sdw_handle_port_interrupt()
1580 ret = sdw_write_no_pm(slave, addr, clear); in sdw_handle_port_interrupt()
1582 dev_err(&slave->dev, in sdw_handle_port_interrupt()
1588 status2 = sdw_read_no_pm(slave, addr); in sdw_handle_port_interrupt()
1590 dev_err(&slave->dev, in sdw_handle_port_interrupt()
1603 dev_warn(&slave->dev, "Reached MAX_RETRY on port read"); in sdw_handle_port_interrupt()
1608 static int sdw_handle_slave_alerts(struct sdw_slave *slave) in sdw_handle_slave_alerts() argument
1620 sdw_modify_slave_status(slave, SDW_SLAVE_ALERT); in sdw_handle_slave_alerts()
1622 ret = pm_runtime_get_sync(&slave->dev); in sdw_handle_slave_alerts()
1624 dev_err(&slave->dev, "Failed to resume device: %d\n", ret); in sdw_handle_slave_alerts()
1625 pm_runtime_put_noidle(&slave->dev); in sdw_handle_slave_alerts()
1630 ret = sdw_read_no_pm(slave, SDW_SCP_INT1); in sdw_handle_slave_alerts()
1632 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1638 ret = sdw_nread_no_pm(slave, SDW_SCP_INTSTAT2, 2, buf2); in sdw_handle_slave_alerts()
1640 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1645 if (slave->id.class_id) { in sdw_handle_slave_alerts()
1646 ret = sdw_read_no_pm(slave, SDW_DP0_INT); in sdw_handle_slave_alerts()
1648 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1659 * Check parity, bus clash and Slave (impl defined) in sdw_handle_slave_alerts()
1663 parity_check = slave->prop.scp_int1_mask & SDW_SCP_INT1_PARITY; in sdw_handle_slave_alerts()
1664 parity_quirk = !slave->first_interrupt_done && in sdw_handle_slave_alerts()
1665 (slave->prop.quirks & SDW_SLAVE_QUIRKS_INVALID_INITIAL_PARITY); in sdw_handle_slave_alerts()
1668 dev_err(&slave->dev, "Parity error detected\n"); in sdw_handle_slave_alerts()
1673 if (slave->prop.scp_int1_mask & SDW_SCP_INT1_BUS_CLASH) in sdw_handle_slave_alerts()
1674 dev_err(&slave->dev, "Bus clash detected\n"); in sdw_handle_slave_alerts()
1686 if (slave->prop.scp_int1_mask & SDW_SCP_INT1_IMPL_DEF) { in sdw_handle_slave_alerts()
1687 dev_dbg(&slave->dev, "Slave impl defined interrupt\n"); in sdw_handle_slave_alerts()
1703 sdw_handle_port_interrupt(slave, bit, in sdw_handle_slave_alerts()
1713 sdw_handle_port_interrupt(slave, in sdw_handle_slave_alerts()
1725 sdw_handle_port_interrupt(slave, in sdw_handle_slave_alerts()
1731 /* Update the Slave driver */ in sdw_handle_slave_alerts()
1733 mutex_lock(&slave->sdw_dev_lock); in sdw_handle_slave_alerts()
1735 if (slave->probed) { in sdw_handle_slave_alerts()
1736 struct device *dev = &slave->dev; in sdw_handle_slave_alerts()
1739 if (slave->prop.use_domain_irq && slave->irq) in sdw_handle_slave_alerts()
1740 handle_nested_irq(slave->irq); in sdw_handle_slave_alerts()
1748 drv->ops->interrupt_callback(slave, &slave_intr); in sdw_handle_slave_alerts()
1752 mutex_unlock(&slave->sdw_dev_lock); in sdw_handle_slave_alerts()
1756 ret = sdw_write_no_pm(slave, SDW_SCP_INT1, clear); in sdw_handle_slave_alerts()
1758 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1764 slave->first_interrupt_done = true; in sdw_handle_slave_alerts()
1770 ret = sdw_read_no_pm(slave, SDW_SCP_INT1); in sdw_handle_slave_alerts()
1772 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1778 ret = sdw_nread_no_pm(slave, SDW_SCP_INTSTAT2, 2, buf2); in sdw_handle_slave_alerts()
1780 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1785 if (slave->id.class_id) { in sdw_handle_slave_alerts()
1786 ret = sdw_read_no_pm(slave, SDW_DP0_INT); in sdw_handle_slave_alerts()
1788 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1801 * Exit loop if Slave is continuously in ALERT state even in sdw_handle_slave_alerts()
1810 dev_warn(&slave->dev, "Reached MAX_RETRY on alert read\n"); in sdw_handle_slave_alerts()
1813 pm_runtime_mark_last_busy(&slave->dev); in sdw_handle_slave_alerts()
1814 pm_runtime_put_autosuspend(&slave->dev); in sdw_handle_slave_alerts()
1819 static int sdw_update_slave_status(struct sdw_slave *slave, in sdw_update_slave_status() argument
1824 mutex_lock(&slave->sdw_dev_lock); in sdw_update_slave_status()
1826 if (slave->probed) { in sdw_update_slave_status()
1827 struct device *dev = &slave->dev; in sdw_update_slave_status()
1831 ret = drv->ops->update_status(slave, status); in sdw_update_slave_status()
1834 mutex_unlock(&slave->sdw_dev_lock); in sdw_update_slave_status()
1840 * sdw_handle_slave_status() - Handle Slave status
1842 * @status: Status for all Slave(s)
1848 struct sdw_slave *slave; in sdw_handle_slave_status() local
1861 slave = sdw_get_slave(bus, i); in sdw_handle_slave_status()
1862 if (!slave) in sdw_handle_slave_status()
1866 slave->status != SDW_SLAVE_UNATTACHED) { in sdw_handle_slave_status()
1867 dev_warn(&slave->dev, "Slave %d state check1: UNATTACHED, status was %d\n", in sdw_handle_slave_status()
1868 i, slave->status); in sdw_handle_slave_status()
1869 sdw_modify_slave_status(slave, SDW_SLAVE_UNATTACHED); in sdw_handle_slave_status()
1872 ret = sdw_update_slave_status(slave, status[i]); in sdw_handle_slave_status()
1874 dev_warn(&slave->dev, "Update Slave status failed:%d\n", ret); in sdw_handle_slave_status()
1879 dev_dbg(bus->dev, "Slave attached, programming device number\n"); in sdw_handle_slave_status()
1899 /* Continue to check other slave statuses */ in sdw_handle_slave_status()
1908 slave = sdw_get_slave(bus, i); in sdw_handle_slave_status()
1909 if (!slave) in sdw_handle_slave_status()
1916 if (slave->status == SDW_SLAVE_UNATTACHED) in sdw_handle_slave_status()
1919 dev_warn(&slave->dev, "Slave %d state check2: UNATTACHED, status was %d\n", in sdw_handle_slave_status()
1920 i, slave->status); in sdw_handle_slave_status()
1922 sdw_modify_slave_status(slave, SDW_SLAVE_UNATTACHED); in sdw_handle_slave_status()
1926 ret = sdw_handle_slave_alerts(slave); in sdw_handle_slave_status()
1928 dev_err(&slave->dev, in sdw_handle_slave_status()
1929 "Slave %d alert handling failed: %d\n", in sdw_handle_slave_status()
1934 if (slave->status == SDW_SLAVE_ATTACHED) in sdw_handle_slave_status()
1937 prev_status = slave->status; in sdw_handle_slave_status()
1938 sdw_modify_slave_status(slave, SDW_SLAVE_ATTACHED); in sdw_handle_slave_status()
1945 ret = sdw_initialize_slave(slave); in sdw_handle_slave_status()
1947 dev_err(&slave->dev, in sdw_handle_slave_status()
1948 "Slave %d initialization failed: %d\n", in sdw_handle_slave_status()
1954 dev_err(&slave->dev, "Invalid slave %d status:%d\n", in sdw_handle_slave_status()
1959 ret = sdw_update_slave_status(slave, status[i]); in sdw_handle_slave_status()
1961 dev_err(&slave->dev, in sdw_handle_slave_status()
1962 "Update Slave status failed:%d\n", ret); in sdw_handle_slave_status()
1964 dev_dbg(&slave->dev, in sdw_handle_slave_status()
1965 "signaling initialization completion for Slave %d\n", in sdw_handle_slave_status()
1966 slave->dev_num); in sdw_handle_slave_status()
1968 complete_all(&slave->initialization_complete); in sdw_handle_slave_status()
1980 pm_request_resume(&slave->dev); in sdw_handle_slave_status()
1990 struct sdw_slave *slave; in sdw_clear_slave_status() local
2002 slave = sdw_get_slave(bus, i); in sdw_clear_slave_status()
2003 if (!slave) in sdw_clear_slave_status()
2006 if (slave->status != SDW_SLAVE_UNATTACHED) { in sdw_clear_slave_status()
2007 sdw_modify_slave_status(slave, SDW_SLAVE_UNATTACHED); in sdw_clear_slave_status()
2008 slave->first_interrupt_done = false; in sdw_clear_slave_status()
2009 sdw_update_slave_status(slave, SDW_SLAVE_UNATTACHED); in sdw_clear_slave_status()
2013 slave->unattach_request = request; in sdw_clear_slave_status()