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()
259 int sdw_fill_msg(struct sdw_msg *msg, struct sdw_slave *slave,  in sdw_fill_msg()  argument
279 		if (slave && !slave->prop.paging_support)  in sdw_fill_msg()
290 	if (!slave) {  in sdw_fill_msg()
293 	} else if (!slave->prop.paging_support) {  in sdw_fill_msg()
294 		dev_err(&slave->dev,  in sdw_fill_msg()
314 int sdw_nread(struct sdw_slave *slave, u32 addr, size_t count, u8 *val)  in sdw_nread()  argument
319 	ret = sdw_fill_msg(&msg, slave, addr, count,  in sdw_nread()
320 			slave->dev_num, SDW_MSG_FLAG_READ, val);  in sdw_nread()
324 	ret = pm_runtime_get_sync(slave->bus->dev);  in sdw_nread()
328 	ret = sdw_transfer(slave->bus, &msg);  in sdw_nread()
329 	pm_runtime_put(slave->bus->dev);  in sdw_nread()
342 int sdw_nwrite(struct sdw_slave *slave, u32 addr, size_t count, u8 *val)  in sdw_nwrite()  argument
347 	ret = sdw_fill_msg(&msg, slave, addr, count,  in sdw_nwrite()
348 			slave->dev_num, SDW_MSG_FLAG_WRITE, val);  in sdw_nwrite()
352 	ret = pm_runtime_get_sync(slave->bus->dev);  in sdw_nwrite()
356 	ret = sdw_transfer(slave->bus, &msg);  in sdw_nwrite()
357 	pm_runtime_put(slave->bus->dev);  in sdw_nwrite()
368 int sdw_read(struct sdw_slave *slave, u32 addr)  in sdw_read()  argument
373 	ret = sdw_nread(slave, addr, 1, &buf);  in sdw_read()
387 int sdw_write(struct sdw_slave *slave, u32 addr, u8 value)  in sdw_write()  argument
389 	return sdw_nwrite(slave, addr, 1, &value);  in sdw_write()
401 	struct sdw_slave *slave = NULL;  in sdw_get_slave()  local
403 	list_for_each_entry(slave, &bus->slaves, node) {  in sdw_get_slave()
404 		if (slave->dev_num == i)  in sdw_get_slave()
405 			return slave;  in sdw_get_slave()
411 static int sdw_compare_devid(struct sdw_slave *slave, struct sdw_slave_id id)  in sdw_compare_devid()  argument
414 	if ((slave->id.unique_id != id.unique_id) ||  in sdw_compare_devid()
415 	    (slave->id.mfg_id != id.mfg_id) ||  in sdw_compare_devid()
416 	    (slave->id.part_id != id.part_id) ||  in sdw_compare_devid()
417 	    (slave->id.class_id != id.class_id))  in sdw_compare_devid()
424 static int sdw_get_device_num(struct sdw_slave *slave)  in sdw_get_device_num()  argument
428 	bit = find_first_zero_bit(slave->bus->assigned, SDW_MAX_DEVICES);  in sdw_get_device_num()
438 	set_bit(bit, slave->bus->assigned);  in sdw_get_device_num()
444 static int sdw_assign_device_num(struct sdw_slave *slave)  in sdw_assign_device_num()  argument
449 	if (!slave->dev_num) {  in sdw_assign_device_num()
450 		mutex_lock(&slave->bus->bus_lock);  in sdw_assign_device_num()
451 		dev_num = sdw_get_device_num(slave);  in sdw_assign_device_num()
452 		mutex_unlock(&slave->bus->bus_lock);  in sdw_assign_device_num()
454 			dev_err(slave->bus->dev, "Get dev_num failed: %d",  in sdw_assign_device_num()
459 		dev_info(slave->bus->dev,  in sdw_assign_device_num()
461 				slave->dev_num);  in sdw_assign_device_num()
464 		dev_num = slave->dev_num;  in sdw_assign_device_num()
465 		slave->dev_num = 0;  in sdw_assign_device_num()
469 	ret = sdw_write(slave, SDW_SCP_DEVNUMBER, dev_num);  in sdw_assign_device_num()
471 		dev_err(&slave->dev, "Program device_num failed: %d", ret);  in sdw_assign_device_num()
476 	slave->dev_num = dev_num;  in sdw_assign_device_num()
513 	struct sdw_slave *slave, *_s;  in sdw_program_device_num()  local
548 		list_for_each_entry_safe(slave, _s, &bus->slaves, node) {  in sdw_program_device_num()
549 			if (sdw_compare_devid(slave, id) == 0) {  in sdw_program_device_num()
558 				ret = sdw_assign_device_num(slave);  in sdw_program_device_num()
560 					dev_err(slave->bus->dev,  in sdw_program_device_num()
588 static void sdw_modify_slave_status(struct sdw_slave *slave,  in sdw_modify_slave_status()  argument
591 	mutex_lock(&slave->bus->bus_lock);  in sdw_modify_slave_status()
592 	slave->status = status;  in sdw_modify_slave_status()
593 	mutex_unlock(&slave->bus->bus_lock);  in sdw_modify_slave_status()
596 int sdw_configure_dpn_intr(struct sdw_slave *slave,  in sdw_configure_dpn_intr()  argument
614 	ret = sdw_update(slave, addr, (mask | SDW_DPN_INT_PORT_READY), val);  in sdw_configure_dpn_intr()
616 		dev_err(slave->bus->dev,  in sdw_configure_dpn_intr()
622 static int sdw_initialize_slave(struct sdw_slave *slave)  in sdw_initialize_slave()  argument
624 	struct sdw_slave_prop *prop = &slave->prop;  in sdw_initialize_slave()
638 	ret = sdw_update(slave, SDW_SCP_INTMASK1, val, val);  in sdw_initialize_slave()
640 		dev_err(slave->bus->dev,  in sdw_initialize_slave()
646 	if (!slave->prop.dp0_prop)  in sdw_initialize_slave()
653 	ret = sdw_update(slave, SDW_DP0_INTMASK, val, val);  in sdw_initialize_slave()
655 		dev_err(slave->bus->dev,  in sdw_initialize_slave()
663 static int sdw_handle_dp0_interrupt(struct sdw_slave *slave, u8 *slave_status)  in sdw_handle_dp0_interrupt()  argument
668 	status = sdw_read(slave, SDW_DP0_INT);  in sdw_handle_dp0_interrupt()
670 		dev_err(slave->bus->dev,  in sdw_handle_dp0_interrupt()
678 			dev_err(&slave->dev, "Test fail for port 0");  in sdw_handle_dp0_interrupt()
688 			complete(&slave->port_ready[0]);  in sdw_handle_dp0_interrupt()
693 			dev_err(&slave->dev, "BRA failed");  in sdw_handle_dp0_interrupt()
706 		ret = sdw_write(slave, SDW_DP0_INT, clear);  in sdw_handle_dp0_interrupt()
708 			dev_err(slave->bus->dev,  in sdw_handle_dp0_interrupt()
714 		status2 = sdw_read(slave, SDW_DP0_INT);  in sdw_handle_dp0_interrupt()
716 			dev_err(slave->bus->dev,  in sdw_handle_dp0_interrupt()
728 		dev_warn(slave->bus->dev, "Reached MAX_RETRY on DP0 read");  in sdw_handle_dp0_interrupt()
733 static int sdw_handle_port_interrupt(struct sdw_slave *slave,  in sdw_handle_port_interrupt()  argument
741 		return sdw_handle_dp0_interrupt(slave, slave_status);  in sdw_handle_port_interrupt()
744 	status = sdw_read(slave, addr);  in sdw_handle_port_interrupt()
746 		dev_err(slave->bus->dev,  in sdw_handle_port_interrupt()
755 			dev_err(&slave->dev, "Test fail for port:%d", port);  in sdw_handle_port_interrupt()
764 			complete(&slave->port_ready[port]);  in sdw_handle_port_interrupt()
778 		ret = sdw_write(slave, addr, clear);  in sdw_handle_port_interrupt()
780 			dev_err(slave->bus->dev,  in sdw_handle_port_interrupt()
786 		status2 = sdw_read(slave, addr);  in sdw_handle_port_interrupt()
788 			dev_err(slave->bus->dev,  in sdw_handle_port_interrupt()
800 		dev_warn(slave->bus->dev, "Reached MAX_RETRY on port read");  in sdw_handle_port_interrupt()
805 static int sdw_handle_slave_alerts(struct sdw_slave *slave)  in sdw_handle_slave_alerts()  argument
814 	sdw_modify_slave_status(slave, SDW_SLAVE_ALERT);  in sdw_handle_slave_alerts()
817 	buf = ret = sdw_read(slave, SDW_SCP_INT1);  in sdw_handle_slave_alerts()
819 		dev_err(slave->bus->dev,  in sdw_handle_slave_alerts()
824 	ret = sdw_nread(slave, SDW_SCP_INTSTAT2, 2, buf2);  in sdw_handle_slave_alerts()
826 		dev_err(slave->bus->dev,  in sdw_handle_slave_alerts()
837 			dev_err(&slave->dev, "Parity error detected");  in sdw_handle_slave_alerts()
842 			dev_err(&slave->dev, "Bus clash error detected");  in sdw_handle_slave_alerts()
854 			dev_dbg(&slave->dev, "Slave impl defined interrupt\n");  in sdw_handle_slave_alerts()
865 			sdw_handle_port_interrupt(slave, bit,  in sdw_handle_slave_alerts()
876 				sdw_handle_port_interrupt(slave,  in sdw_handle_slave_alerts()
888 				sdw_handle_port_interrupt(slave,  in sdw_handle_slave_alerts()
895 		if (slave_notify && (slave->ops) &&  in sdw_handle_slave_alerts()
896 					(slave->ops->interrupt_callback)) {  in sdw_handle_slave_alerts()
901 			slave->ops->interrupt_callback(slave, &slave_intr);  in sdw_handle_slave_alerts()
905 		ret = sdw_write(slave, SDW_SCP_INT1, clear);  in sdw_handle_slave_alerts()
907 			dev_err(slave->bus->dev,  in sdw_handle_slave_alerts()
916 		_buf = ret = sdw_read(slave, SDW_SCP_INT1);  in sdw_handle_slave_alerts()
918 			dev_err(slave->bus->dev,  in sdw_handle_slave_alerts()
923 		ret = sdw_nread(slave, SDW_SCP_INTSTAT2, 2, _buf2);  in sdw_handle_slave_alerts()
925 			dev_err(slave->bus->dev,  in sdw_handle_slave_alerts()
946 		dev_warn(slave->bus->dev, "Reached MAX_RETRY on alert read");  in sdw_handle_slave_alerts()
951 static int sdw_update_slave_status(struct sdw_slave *slave,  in sdw_update_slave_status()  argument
954 	if ((slave->ops) && (slave->ops->update_status))  in sdw_update_slave_status()
955 		return slave->ops->update_status(slave, status);  in sdw_update_slave_status()
969 	struct sdw_slave *slave;  in sdw_handle_slave_status()  local
987 		slave = sdw_get_slave(bus, i);  in sdw_handle_slave_status()
988 		if (!slave)  in sdw_handle_slave_status()
993 			if (slave->status == SDW_SLAVE_UNATTACHED)  in sdw_handle_slave_status()
996 			sdw_modify_slave_status(slave, SDW_SLAVE_UNATTACHED);  in sdw_handle_slave_status()
1000 			ret = sdw_handle_slave_alerts(slave);  in sdw_handle_slave_status()
1008 			if (slave->status == SDW_SLAVE_ATTACHED)  in sdw_handle_slave_status()
1011 			prev_status = slave->status;  in sdw_handle_slave_status()
1012 			sdw_modify_slave_status(slave, SDW_SLAVE_ATTACHED);  in sdw_handle_slave_status()
1017 			ret = sdw_initialize_slave(slave);  in sdw_handle_slave_status()
1031 		ret = sdw_update_slave_status(slave, status[i]);  in sdw_handle_slave_status()
1033 			dev_err(slave->bus->dev,  in sdw_handle_slave_status()