Lines Matching full:slave
69 * Create Slave devices based on Slaves described in in sdw_add_bus_master()
103 struct sdw_slave *slave = dev_to_sdw_dev(dev); in sdw_delete_slave() local
104 struct sdw_bus *bus = slave->bus; in sdw_delete_slave()
108 if (slave->dev_num) /* clear dev_num if assigned */ in sdw_delete_slave()
109 clear_bit(slave->dev_num, bus->assigned); in sdw_delete_slave()
111 list_del_init(&slave->node); in sdw_delete_slave()
209 * sdw_transfer() - Synchronous transfer message to a SDW Slave device
221 dev_err(bus->dev, "trf on Slave %d failed:%d\n", in sdw_transfer()
233 * sdw_transfer_defer() - Asynchronously transfer message to a SDW Slave device
250 dev_err(bus->dev, "Defer trf on Slave %d failed:%d\n", in sdw_transfer_defer()
260 int sdw_fill_msg(struct sdw_msg *msg, struct sdw_slave *slave, in sdw_fill_msg() argument
280 if (slave && !slave->prop.paging_support) in sdw_fill_msg()
291 if (!slave) { in sdw_fill_msg()
292 pr_err("SDW: No slave for paging addr\n"); in sdw_fill_msg()
294 } else if (!slave->prop.paging_support) { in sdw_fill_msg()
295 dev_err(&slave->dev, in sdw_fill_msg()
309 * sdw_nread() - Read "n" contiguous SDW Slave registers
310 * @slave: SDW Slave
315 int sdw_nread(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nread() argument
320 ret = sdw_fill_msg(&msg, slave, addr, count, in sdw_nread()
321 slave->dev_num, SDW_MSG_FLAG_READ, val); in sdw_nread()
325 ret = pm_runtime_get_sync(slave->bus->dev); in sdw_nread()
329 ret = sdw_transfer(slave->bus, &msg); in sdw_nread()
330 pm_runtime_put(slave->bus->dev); in sdw_nread()
337 * sdw_nwrite() - Write "n" contiguous SDW Slave registers
338 * @slave: SDW Slave
343 int sdw_nwrite(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nwrite() argument
348 ret = sdw_fill_msg(&msg, slave, addr, count, in sdw_nwrite()
349 slave->dev_num, SDW_MSG_FLAG_WRITE, val); in sdw_nwrite()
353 ret = pm_runtime_get_sync(slave->bus->dev); in sdw_nwrite()
357 ret = sdw_transfer(slave->bus, &msg); in sdw_nwrite()
358 pm_runtime_put(slave->bus->dev); in sdw_nwrite()
365 * sdw_read() - Read a SDW Slave register
366 * @slave: SDW Slave
369 int sdw_read(struct sdw_slave *slave, u32 addr) in sdw_read() argument
374 ret = sdw_nread(slave, addr, 1, &buf); in sdw_read()
383 * sdw_write() - Write a SDW Slave register
384 * @slave: SDW Slave
388 int sdw_write(struct sdw_slave *slave, u32 addr, u8 value) in sdw_write() argument
390 return sdw_nwrite(slave, addr, 1, &value); in sdw_write()
402 struct sdw_slave *slave = NULL; in sdw_get_slave() local
404 list_for_each_entry(slave, &bus->slaves, node) { in sdw_get_slave()
405 if (slave->dev_num == i) in sdw_get_slave()
406 return slave; in sdw_get_slave()
412 static int sdw_compare_devid(struct sdw_slave *slave, struct sdw_slave_id id) in sdw_compare_devid() argument
415 if ((slave->id.unique_id != id.unique_id) || in sdw_compare_devid()
416 (slave->id.mfg_id != id.mfg_id) || in sdw_compare_devid()
417 (slave->id.part_id != id.part_id) || in sdw_compare_devid()
418 (slave->id.class_id != id.class_id)) in sdw_compare_devid()
425 static int sdw_get_device_num(struct sdw_slave *slave) in sdw_get_device_num() argument
429 bit = find_first_zero_bit(slave->bus->assigned, SDW_MAX_DEVICES); in sdw_get_device_num()
436 * Do not update dev_num in Slave data structure here, in sdw_get_device_num()
439 set_bit(bit, slave->bus->assigned); in sdw_get_device_num()
445 static int sdw_assign_device_num(struct sdw_slave *slave) in sdw_assign_device_num() argument
450 if (!slave->dev_num) { in sdw_assign_device_num()
451 mutex_lock(&slave->bus->bus_lock); in sdw_assign_device_num()
452 dev_num = sdw_get_device_num(slave); in sdw_assign_device_num()
453 mutex_unlock(&slave->bus->bus_lock); in sdw_assign_device_num()
455 dev_err(slave->bus->dev, "Get dev_num failed: %d", in sdw_assign_device_num()
460 dev_info(slave->bus->dev, in sdw_assign_device_num()
461 "Slave already registered dev_num:%d", in sdw_assign_device_num()
462 slave->dev_num); in sdw_assign_device_num()
464 /* Clear the slave->dev_num to transfer message on device 0 */ in sdw_assign_device_num()
465 dev_num = slave->dev_num; in sdw_assign_device_num()
466 slave->dev_num = 0; in sdw_assign_device_num()
470 ret = sdw_write(slave, SDW_SCP_DEVNUMBER, dev_num); in sdw_assign_device_num()
472 dev_err(&slave->dev, "Program device_num failed: %d", ret); in sdw_assign_device_num()
477 slave->dev_num = dev_num; in sdw_assign_device_num()
485 dev_dbg(bus->dev, "SDW Slave Addr: %llx", addr); in sdw_extract_slave_id()
505 "SDW Slave class_id %x, part_id %x, mfg_id %x, unique_id %x, version %x", in sdw_extract_slave_id()
514 struct sdw_slave *slave, *_s; in sdw_program_device_num() local
521 /* No Slave, so use raw xfer api */ in sdw_program_device_num()
549 list_for_each_entry_safe(slave, _s, &bus->slaves, node) { in sdw_program_device_num()
550 if (sdw_compare_devid(slave, id) == 0) { in sdw_program_device_num()
554 * Assign a new dev_num to this Slave and in sdw_program_device_num()
559 ret = sdw_assign_device_num(slave); in sdw_program_device_num()
561 dev_err(slave->bus->dev, in sdw_program_device_num()
573 dev_err(bus->dev, "Slave Entry not found"); in sdw_program_device_num()
589 static void sdw_modify_slave_status(struct sdw_slave *slave, in sdw_modify_slave_status() argument
592 mutex_lock(&slave->bus->bus_lock); in sdw_modify_slave_status()
593 slave->status = status; in sdw_modify_slave_status()
594 mutex_unlock(&slave->bus->bus_lock); in sdw_modify_slave_status()
597 int sdw_configure_dpn_intr(struct sdw_slave *slave, in sdw_configure_dpn_intr() argument
615 ret = sdw_update(slave, addr, (mask | SDW_DPN_INT_PORT_READY), val); in sdw_configure_dpn_intr()
617 dev_err(slave->bus->dev, in sdw_configure_dpn_intr()
623 static int sdw_initialize_slave(struct sdw_slave *slave) in sdw_initialize_slave() argument
625 struct sdw_slave_prop *prop = &slave->prop; in sdw_initialize_slave()
633 * from Slave property in sdw_initialize_slave()
639 ret = sdw_update(slave, SDW_SCP_INTMASK1, val, val); in sdw_initialize_slave()
641 dev_err(slave->bus->dev, in sdw_initialize_slave()
647 if (!slave->prop.dp0_prop) in sdw_initialize_slave()
654 ret = sdw_update(slave, SDW_DP0_INTMASK, val, val); in sdw_initialize_slave()
656 dev_err(slave->bus->dev, in sdw_initialize_slave()
664 static int sdw_handle_dp0_interrupt(struct sdw_slave *slave, u8 *slave_status) in sdw_handle_dp0_interrupt() argument
669 status = sdw_read(slave, SDW_DP0_INT); in sdw_handle_dp0_interrupt()
671 dev_err(slave->bus->dev, in sdw_handle_dp0_interrupt()
679 dev_err(&slave->dev, "Test fail for port 0"); in sdw_handle_dp0_interrupt()
689 complete(&slave->port_ready[0]); in sdw_handle_dp0_interrupt()
694 dev_err(&slave->dev, "BRA failed"); in sdw_handle_dp0_interrupt()
707 ret = sdw_write(slave, SDW_DP0_INT, clear); in sdw_handle_dp0_interrupt()
709 dev_err(slave->bus->dev, in sdw_handle_dp0_interrupt()
715 status2 = sdw_read(slave, SDW_DP0_INT); in sdw_handle_dp0_interrupt()
717 dev_err(slave->bus->dev, in sdw_handle_dp0_interrupt()
729 dev_warn(slave->bus->dev, "Reached MAX_RETRY on DP0 read"); in sdw_handle_dp0_interrupt()
734 static int sdw_handle_port_interrupt(struct sdw_slave *slave, in sdw_handle_port_interrupt() argument
742 return sdw_handle_dp0_interrupt(slave, slave_status); in sdw_handle_port_interrupt()
745 status = sdw_read(slave, addr); in sdw_handle_port_interrupt()
747 dev_err(slave->bus->dev, in sdw_handle_port_interrupt()
756 dev_err(&slave->dev, "Test fail for port:%d", port); in sdw_handle_port_interrupt()
765 complete(&slave->port_ready[port]); in sdw_handle_port_interrupt()
779 ret = sdw_write(slave, addr, clear); in sdw_handle_port_interrupt()
781 dev_err(slave->bus->dev, in sdw_handle_port_interrupt()
787 status2 = sdw_read(slave, addr); in sdw_handle_port_interrupt()
789 dev_err(slave->bus->dev, in sdw_handle_port_interrupt()
801 dev_warn(slave->bus->dev, "Reached MAX_RETRY on port read"); in sdw_handle_port_interrupt()
806 static int sdw_handle_slave_alerts(struct sdw_slave *slave) in sdw_handle_slave_alerts() argument
815 sdw_modify_slave_status(slave, SDW_SLAVE_ALERT); in sdw_handle_slave_alerts()
818 buf = ret = sdw_read(slave, SDW_SCP_INT1); in sdw_handle_slave_alerts()
820 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
825 ret = sdw_nread(slave, SDW_SCP_INTSTAT2, 2, buf2); in sdw_handle_slave_alerts()
827 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
834 * Check parity, bus clash and Slave (impl defined) in sdw_handle_slave_alerts()
838 dev_err(&slave->dev, "Parity error detected"); in sdw_handle_slave_alerts()
843 dev_err(&slave->dev, "Bus clash error detected"); in sdw_handle_slave_alerts()
855 dev_dbg(&slave->dev, "Slave impl defined interrupt\n"); in sdw_handle_slave_alerts()
866 sdw_handle_port_interrupt(slave, bit, in sdw_handle_slave_alerts()
877 sdw_handle_port_interrupt(slave, in sdw_handle_slave_alerts()
889 sdw_handle_port_interrupt(slave, in sdw_handle_slave_alerts()
895 /* Update the Slave driver */ in sdw_handle_slave_alerts()
896 if (slave_notify && (slave->ops) && in sdw_handle_slave_alerts()
897 (slave->ops->interrupt_callback)) { in sdw_handle_slave_alerts()
902 slave->ops->interrupt_callback(slave, &slave_intr); in sdw_handle_slave_alerts()
906 ret = sdw_write(slave, SDW_SCP_INT1, clear); in sdw_handle_slave_alerts()
908 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
917 _buf = ret = sdw_read(slave, SDW_SCP_INT1); in sdw_handle_slave_alerts()
919 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
924 ret = sdw_nread(slave, SDW_SCP_INTSTAT2, 2, _buf2); in sdw_handle_slave_alerts()
926 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
938 * Exit loop if Slave is continuously in ALERT state even in sdw_handle_slave_alerts()
947 dev_warn(slave->bus->dev, "Reached MAX_RETRY on alert read"); in sdw_handle_slave_alerts()
952 static int sdw_update_slave_status(struct sdw_slave *slave, in sdw_update_slave_status() argument
955 if ((slave->ops) && (slave->ops->update_status)) in sdw_update_slave_status()
956 return slave->ops->update_status(slave, status); in sdw_update_slave_status()
962 * sdw_handle_slave_status() - Handle Slave status
964 * @status: Status for all Slave(s)
970 struct sdw_slave *slave; in sdw_handle_slave_status() local
976 dev_err(bus->dev, "Slave attach failed: %d", ret); in sdw_handle_slave_status()
979 /* Continue to check other slave statuses */ in sdw_handle_slave_status()
988 slave = sdw_get_slave(bus, i); in sdw_handle_slave_status()
989 if (!slave) in sdw_handle_slave_status()
994 if (slave->status == SDW_SLAVE_UNATTACHED) in sdw_handle_slave_status()
997 sdw_modify_slave_status(slave, SDW_SLAVE_UNATTACHED); in sdw_handle_slave_status()
1001 ret = sdw_handle_slave_alerts(slave); in sdw_handle_slave_status()
1004 "Slave %d alert handling failed: %d", in sdw_handle_slave_status()
1009 if (slave->status == SDW_SLAVE_ATTACHED) in sdw_handle_slave_status()
1012 prev_status = slave->status; in sdw_handle_slave_status()
1013 sdw_modify_slave_status(slave, SDW_SLAVE_ATTACHED); in sdw_handle_slave_status()
1018 ret = sdw_initialize_slave(slave); in sdw_handle_slave_status()
1021 "Slave %d initialization failed: %d", in sdw_handle_slave_status()
1027 dev_err(bus->dev, "Invalid slave %d status:%d", in sdw_handle_slave_status()
1032 ret = sdw_update_slave_status(slave, status[i]); in sdw_handle_slave_status()
1034 dev_err(slave->bus->dev, in sdw_handle_slave_status()
1035 "Update Slave status failed:%d", ret); in sdw_handle_slave_status()