77 	 * Create Slave devices based on Slaves described in  in sdw_add_bus_master()
113 	struct sdw_slave *slave = dev_to_sdw_dev(dev);  in sdw_delete_slave()  local
114 	struct sdw_bus *bus = slave->bus;  in sdw_delete_slave()
116 	sdw_slave_debugfs_exit(slave);  in sdw_delete_slave()
120 	if (slave->dev_num) /* clear dev_num if assigned */  in sdw_delete_slave()
121 		clear_bit(slave->dev_num, bus->assigned);  in sdw_delete_slave()
123 	list_del_init(&slave->node);  in sdw_delete_slave()
224  * sdw_transfer() - Synchronous transfer message to a SDW Slave device
236 		dev_err(bus->dev, "trf on Slave %d failed:%d\n",  in sdw_transfer()
248  * sdw_transfer_defer() - Asynchronously transfer message to a SDW Slave device
265 		dev_err(bus->dev, "Defer trf on Slave %d failed:%d\n",  in sdw_transfer_defer()
274 int sdw_fill_msg(struct sdw_msg *msg, struct sdw_slave *slave,  in sdw_fill_msg()  argument
292 		if (slave && !slave->prop.paging_support)  in sdw_fill_msg()
303 	if (!slave) {  in sdw_fill_msg()
304 		pr_err("SDW: No slave for paging addr\n");  in sdw_fill_msg()
306 	} else if (!slave->prop.paging_support) {  in sdw_fill_msg()
307 		dev_err(&slave->dev,  in sdw_fill_msg()
321  * sdw_nread() - Read "n" contiguous SDW Slave registers
322  * @slave: SDW Slave
327 int sdw_nread(struct sdw_slave *slave, u32 addr, size_t count, u8 *val)  in sdw_nread()  argument
332 	ret = sdw_fill_msg(&msg, slave, addr, count,  in sdw_nread()
333 			   slave->dev_num, SDW_MSG_FLAG_READ, val);  in sdw_nread()
337 	ret = pm_runtime_get_sync(slave->bus->dev);  in sdw_nread()
341 	ret = sdw_transfer(slave->bus, &msg);  in sdw_nread()
342 	pm_runtime_put(slave->bus->dev);  in sdw_nread()
349  * sdw_nwrite() - Write "n" contiguous SDW Slave registers
350  * @slave: SDW Slave
355 int sdw_nwrite(struct sdw_slave *slave, u32 addr, size_t count, u8 *val)  in sdw_nwrite()  argument
360 	ret = sdw_fill_msg(&msg, slave, addr, count,  in sdw_nwrite()
361 			   slave->dev_num, SDW_MSG_FLAG_WRITE, val);  in sdw_nwrite()
365 	ret = pm_runtime_get_sync(slave->bus->dev);  in sdw_nwrite()
369 	ret = sdw_transfer(slave->bus, &msg);  in sdw_nwrite()
370 	pm_runtime_put(slave->bus->dev);  in sdw_nwrite()
377  * sdw_read() - Read a SDW Slave register
378  * @slave: SDW Slave
381 int sdw_read(struct sdw_slave *slave, u32 addr)  in sdw_read()  argument
386 	ret = sdw_nread(slave, addr, 1, &buf);  in sdw_read()
395  * sdw_write() - Write a SDW Slave register
396  * @slave: SDW Slave
400 int sdw_write(struct sdw_slave *slave, u32 addr, u8 value)  in sdw_write()  argument
402 	return sdw_nwrite(slave, addr, 1, &value);  in sdw_write()
413 	struct sdw_slave *slave = NULL;  in sdw_get_slave()  local
415 	list_for_each_entry(slave, &bus->slaves, node) {  in sdw_get_slave()
416 		if (slave->dev_num == i)  in sdw_get_slave()
417 			return slave;  in sdw_get_slave()
423 static int sdw_compare_devid(struct sdw_slave *slave, struct sdw_slave_id id)  in sdw_compare_devid()  argument
425 	if (slave->id.unique_id != id.unique_id ||  in sdw_compare_devid()
426 	    slave->id.mfg_id != id.mfg_id ||  in sdw_compare_devid()
427 	    slave->id.part_id != id.part_id ||  in sdw_compare_devid()
428 	    slave->id.class_id != id.class_id)  in sdw_compare_devid()
435 static int sdw_get_device_num(struct sdw_slave *slave)  in sdw_get_device_num()  argument
439 	bit = find_first_zero_bit(slave->bus->assigned, SDW_MAX_DEVICES);  in sdw_get_device_num()
446 	 * Do not update dev_num in Slave data structure here,  in sdw_get_device_num()
449 	set_bit(bit, slave->bus->assigned);  in sdw_get_device_num()
455 static int sdw_assign_device_num(struct sdw_slave *slave)  in sdw_assign_device_num()  argument
460 	if (!slave->dev_num) {  in sdw_assign_device_num()
461 		mutex_lock(&slave->bus->bus_lock);  in sdw_assign_device_num()
462 		dev_num = sdw_get_device_num(slave);  in sdw_assign_device_num()
463 		mutex_unlock(&slave->bus->bus_lock);  in sdw_assign_device_num()
465 			dev_err(slave->bus->dev, "Get dev_num failed: %d\n",  in sdw_assign_device_num()
470 		dev_info(slave->bus->dev,  in sdw_assign_device_num()
471 			 "Slave already registered dev_num:%d\n",  in sdw_assign_device_num()
472 			 slave->dev_num);  in sdw_assign_device_num()
474 		/* Clear the slave->dev_num to transfer message on device 0 */  in sdw_assign_device_num()
475 		dev_num = slave->dev_num;  in sdw_assign_device_num()
476 		slave->dev_num = 0;  in sdw_assign_device_num()
479 	ret = sdw_write(slave, SDW_SCP_DEVNUMBER, dev_num);  in sdw_assign_device_num()
481 		dev_err(&slave->dev, "Program device_num %d failed: %d\n",  in sdw_assign_device_num()
487 	slave->dev_num = dev_num;  in sdw_assign_device_num()
495 	dev_dbg(bus->dev, "SDW Slave Addr: %llx\n", addr);  in sdw_extract_slave_id()
515 		"SDW Slave class_id %x, part_id %x, mfg_id %x, unique_id %x, version %x\n",  in sdw_extract_slave_id()
523 	struct sdw_slave *slave, *_s;  in sdw_program_device_num()  local
530 	/* No Slave, so use raw xfer api */  in sdw_program_device_num()
559 		list_for_each_entry_safe(slave, _s, &bus->slaves, node) {  in sdw_program_device_num()
560 			if (sdw_compare_devid(slave, id) == 0) {  in sdw_program_device_num()
564 				 * Assign a new dev_num to this Slave and  in sdw_program_device_num()
569 				ret = sdw_assign_device_num(slave);  in sdw_program_device_num()
571 					dev_err(slave->bus->dev,  in sdw_program_device_num()
583 			dev_err(bus->dev, "Slave Entry not found\n");  in sdw_program_device_num()
599 static void sdw_modify_slave_status(struct sdw_slave *slave,  in sdw_modify_slave_status()  argument
602 	mutex_lock(&slave->bus->bus_lock);  in sdw_modify_slave_status()
603 	slave->status = status;  in sdw_modify_slave_status()
604 	mutex_unlock(&slave->bus->bus_lock);  in sdw_modify_slave_status()
607 int sdw_configure_dpn_intr(struct sdw_slave *slave,  in sdw_configure_dpn_intr()  argument
625 	ret = sdw_update(slave, addr, (mask | SDW_DPN_INT_PORT_READY), val);  in sdw_configure_dpn_intr()
627 		dev_err(slave->bus->dev,  in sdw_configure_dpn_intr()
633 static int sdw_initialize_slave(struct sdw_slave *slave)  in sdw_initialize_slave()  argument
635 	struct sdw_slave_prop *prop = &slave->prop;  in sdw_initialize_slave()
643 	 * from Slave property  in sdw_initialize_slave()
649 	ret = sdw_update(slave, SDW_SCP_INTMASK1, val, val);  in sdw_initialize_slave()
651 		dev_err(slave->bus->dev,  in sdw_initialize_slave()
657 	if (!slave->prop.dp0_prop)  in sdw_initialize_slave()
664 	ret = sdw_update(slave, SDW_DP0_INTMASK, val, val);  in sdw_initialize_slave()
666 		dev_err(slave->bus->dev,  in sdw_initialize_slave()
674 static int sdw_handle_dp0_interrupt(struct sdw_slave *slave, u8 *slave_status)  in sdw_handle_dp0_interrupt()  argument
679 	status = sdw_read(slave, SDW_DP0_INT);  in sdw_handle_dp0_interrupt()
681 		dev_err(slave->bus->dev,  in sdw_handle_dp0_interrupt()
688 			dev_err(&slave->dev, "Test fail for port 0\n");  in sdw_handle_dp0_interrupt()
698 			complete(&slave->port_ready[0]);  in sdw_handle_dp0_interrupt()
703 			dev_err(&slave->dev, "BRA failed\n");  in sdw_handle_dp0_interrupt()
716 		ret = sdw_write(slave, SDW_DP0_INT, clear);  in sdw_handle_dp0_interrupt()
718 			dev_err(slave->bus->dev,  in sdw_handle_dp0_interrupt()
724 		status2 = sdw_read(slave, SDW_DP0_INT);  in sdw_handle_dp0_interrupt()
726 			dev_err(slave->bus->dev,  in sdw_handle_dp0_interrupt()
738 		dev_warn(slave->bus->dev, "Reached MAX_RETRY on DP0 read\n");  in sdw_handle_dp0_interrupt()
743 static int sdw_handle_port_interrupt(struct sdw_slave *slave,  in sdw_handle_port_interrupt()  argument
751 		return sdw_handle_dp0_interrupt(slave, slave_status);  in sdw_handle_port_interrupt()
754 	status = sdw_read(slave, addr);  in sdw_handle_port_interrupt()
756 		dev_err(slave->bus->dev,  in sdw_handle_port_interrupt()
764 			dev_err(&slave->dev, "Test fail for port:%d\n", port);  in sdw_handle_port_interrupt()
773 			complete(&slave->port_ready[port]);  in sdw_handle_port_interrupt()
786 		ret = sdw_write(slave, addr, clear);  in sdw_handle_port_interrupt()
788 			dev_err(slave->bus->dev,  in sdw_handle_port_interrupt()
794 		status2 = sdw_read(slave, addr);  in sdw_handle_port_interrupt()
796 			dev_err(slave->bus->dev,  in sdw_handle_port_interrupt()
808 		dev_warn(slave->bus->dev, "Reached MAX_RETRY on port read");  in sdw_handle_port_interrupt()
813 static int sdw_handle_slave_alerts(struct sdw_slave *slave)  in sdw_handle_slave_alerts()  argument
822 	sdw_modify_slave_status(slave, SDW_SLAVE_ALERT);  in sdw_handle_slave_alerts()
825 	ret = sdw_read(slave, SDW_SCP_INT1);  in sdw_handle_slave_alerts()
827 		dev_err(slave->bus->dev,  in sdw_handle_slave_alerts()
833 	ret = sdw_nread(slave, SDW_SCP_INTSTAT2, 2, buf2);  in sdw_handle_slave_alerts()
835 		dev_err(slave->bus->dev,  in sdw_handle_slave_alerts()
842 		 * Check parity, bus clash and Slave (impl defined)  in sdw_handle_slave_alerts()
846 			dev_err(&slave->dev, "Parity error detected\n");  in sdw_handle_slave_alerts()
851 			dev_err(&slave->dev, "Bus clash error detected\n");  in sdw_handle_slave_alerts()
863 			dev_dbg(&slave->dev, "Slave impl defined interrupt\n");  in sdw_handle_slave_alerts()
874 			sdw_handle_port_interrupt(slave, bit,  in sdw_handle_slave_alerts()
884 				sdw_handle_port_interrupt(slave,  in sdw_handle_slave_alerts()
896 				sdw_handle_port_interrupt(slave,  in sdw_handle_slave_alerts()
902 		/* Update the Slave driver */  in sdw_handle_slave_alerts()
903 		if (slave_notify && slave->ops &&  in sdw_handle_slave_alerts()
904 		    slave->ops->interrupt_callback) {  in sdw_handle_slave_alerts()
909 			slave->ops->interrupt_callback(slave, &slave_intr);  in sdw_handle_slave_alerts()
913 		ret = sdw_write(slave, SDW_SCP_INT1, clear);  in sdw_handle_slave_alerts()
915 			dev_err(slave->bus->dev,  in sdw_handle_slave_alerts()
924 		ret = sdw_read(slave, SDW_SCP_INT1);  in sdw_handle_slave_alerts()
926 			dev_err(slave->bus->dev,  in sdw_handle_slave_alerts()
932 		ret = sdw_nread(slave, SDW_SCP_INTSTAT2, 2, _buf2);  in sdw_handle_slave_alerts()
934 			dev_err(slave->bus->dev,  in sdw_handle_slave_alerts()
946 		 * Exit loop if Slave is continuously in ALERT state even  in sdw_handle_slave_alerts()
955 		dev_warn(slave->bus->dev, "Reached MAX_RETRY on alert read\n");  in sdw_handle_slave_alerts()
960 static int sdw_update_slave_status(struct sdw_slave *slave,  in sdw_update_slave_status()  argument
963 	if (slave->ops && slave->ops->update_status)  in sdw_update_slave_status()
964 		return slave->ops->update_status(slave, status);  in sdw_update_slave_status()
970  * sdw_handle_slave_status() - Handle Slave status
972  * @status: Status for all Slave(s)
978 	struct sdw_slave *slave;  in sdw_handle_slave_status()  local
982 		dev_dbg(bus->dev, "Slave attached, programming device number\n");  in sdw_handle_slave_status()
985 			dev_err(bus->dev, "Slave attach failed: %d\n", ret);  in sdw_handle_slave_status()
993 	/* Continue to check other slave statuses */  in sdw_handle_slave_status()
1002 		slave = sdw_get_slave(bus, i);  in sdw_handle_slave_status()
1003 		if (!slave)  in sdw_handle_slave_status()
1008 			if (slave->status == SDW_SLAVE_UNATTACHED)  in sdw_handle_slave_status()
1011 			sdw_modify_slave_status(slave, SDW_SLAVE_UNATTACHED);  in sdw_handle_slave_status()
1015 			ret = sdw_handle_slave_alerts(slave);  in sdw_handle_slave_status()
1018 					"Slave %d alert handling failed: %d\n",  in sdw_handle_slave_status()
1023 			if (slave->status == SDW_SLAVE_ATTACHED)  in sdw_handle_slave_status()
1026 			prev_status = slave->status;  in sdw_handle_slave_status()
1027 			sdw_modify_slave_status(slave, SDW_SLAVE_ATTACHED);  in sdw_handle_slave_status()
1032 			ret = sdw_initialize_slave(slave);  in sdw_handle_slave_status()
1035 					"Slave %d initialization failed: %d\n",  in sdw_handle_slave_status()
1041 			dev_err(bus->dev, "Invalid slave %d status:%d\n",  in sdw_handle_slave_status()
1046 		ret = sdw_update_slave_status(slave, status[i]);  in sdw_handle_slave_status()
1048 			dev_err(slave->bus->dev,  in sdw_handle_slave_status()
1049 				"Update Slave status failed:%d\n", ret);  in sdw_handle_slave_status()