drivers/soundwire/bus.c

45 	int ret;
52 	ret = sdw_get_id(bus);
53 	if (ret < 0) {
55 		return ret;
58 	ret = sdw_master_device_add(bus, parent, fwnode);
59 	if (ret < 0) {
62 		return ret;
95 		ret = bus->ops->read_prop(bus);
96 		if (ret < 0) {
98 				"Bus read properties failed:%d\n", ret);
99 			return ret;
132 		ret = sdw_acpi_find_slaves(bus);
134 		ret = sdw_of_find_slaves(bus);
136 		ret = -ENOTSUPP; /* No ACPI/DT so error out */
138 	if (ret < 0) {
139 		dev_err(bus->dev, "Finding slaves failed:%d\n", ret);
140 		return ret;
158 	ret = sdw_irq_create(bus, fwnode);
159 	if (ret)
160 		return ret;
235 	int ret = 0, i;
239 		ret = find_response_code(resp);
242 		if (ret == 0 || ret == -ENODATA)
243 			return ret;
246 	return ret;
255 	int ret = 0, i;
263 		ret = find_response_code(resp);
265 		if (ret == 0 || ret == -ENODATA)
266 			return ret;
269 	return ret;
274 	int ret;
276 	ret = do_transfer(bus, msg);
277 	if (ret != 0 && ret != -ENODATA)
279 			msg->dev_num, ret,
283 	return ret;
293 	int ret;
297 	ret = sdw_transfer_unlocked(bus, msg);
301 	return ret;
345 	int ret;
350 	ret = do_transfer_defer(bus, msg);
351 	if (ret != 0 && ret != -ENODATA)
353 			msg->dev_num, ret);
355 	return ret;
416 	int ret;
422 		ret = sdw_fill_msg(&msg, slave, addr, size, slave->dev_num, flags, val);
423 		if (ret < 0)
424 			return ret;
426 		ret = sdw_transfer(slave->bus, &msg);
427 		if (ret < 0 && !slave->is_mockup_device)
428 			return ret;
487 	int ret;
489 	ret = sdw_fill_msg(&msg, NULL, addr, 1, dev_num,
491 	if (ret < 0)
492 		return ret;
494 	ret = sdw_transfer(bus, &msg);
495 	if (ret < 0)
496 		return ret;
505 	int ret;
507 	ret = sdw_fill_msg(&msg, NULL, addr, 1, dev_num,
509 	if (ret < 0)
510 		return ret;
519 	int ret;
521 	ret = sdw_fill_msg(&msg, NULL, addr, 1, dev_num,
523 	if (ret < 0)
524 		return ret;
526 	ret = sdw_transfer_unlocked(bus, &msg);
527 	if (ret < 0)
528 		return ret;
537 	int ret;
539 	ret = sdw_fill_msg(&msg, NULL, addr, 1, dev_num,
541 	if (ret < 0)
542 		return ret;
556 	int ret;
558 	ret = sdw_nread_no_pm(slave, addr, 1, &buf);
559 	if (ret < 0)
560 		return ret;
607 	int ret;
609 	ret = pm_runtime_get_sync(&slave->dev);
610 	if (ret < 0 && ret != -EACCES) {
612 		return ret;
615 	ret = sdw_nread_no_pm(slave, addr, count, val);
620 	return ret;
638 	int ret;
640 	ret = pm_runtime_get_sync(&slave->dev);
641 	if (ret < 0 && ret != -EACCES) {
643 		return ret;
646 	ret = sdw_nwrite_no_pm(slave, addr, count, val);
651 	return ret;
666 	int ret;
668 	ret = sdw_nread(slave, addr, 1, &buf);
669 	if (ret < 0)
670 		return ret;
752 	int ret, dev_num;
783 	ret = sdw_write_no_pm(slave, SDW_SCP_DEVNUMBER, dev_num);
784 	if (ret < 0) {
786 			dev_num, ret);
787 		return ret;
823 	int count = 0, ret;
829 	ret = sdw_fill_msg(&msg, NULL, SDW_SCP_DEVID_0,
831 	if (ret < 0)
832 		return ret;
835 		ret = sdw_transfer(bus, &msg);
836 		if (ret == -ENODATA) { /* end of device id reads */
838 			ret = 0;
841 		if (ret < 0) {
842 			dev_err(bus->dev, "DEVID read fail:%d\n", ret);
878 				ret = sdw_assign_device_num(slave);
879 				if (ret < 0) {
882 						ret);
883 					return ret;
914 	} while (ret == 0 && count < (SDW_MAX_DEVICES * 2));
916 	return ret;
954 	int ret = 0;
963 			ret = drv->ops->clk_stop(slave, mode, type);
968 	return ret;
977 	int ret;
990 		ret = sdw_read_no_pm(slave, SDW_SCP_SYSTEMCTRL);
991 		if (ret < 0) {
992 			if (ret != -ENODATA)
993 				dev_err(&slave->dev, "SDW_SCP_SYSTEMCTRL read failed:%d\n", ret);
994 			return ret;
996 		val = ret;
1000 	ret = sdw_write_no_pm(slave, SDW_SCP_SYSTEMCTRL, val);
1002 	if (ret < 0 && ret != -ENODATA)
1003 		dev_err(&slave->dev, "SDW_SCP_SYSTEMCTRL write failed:%d\n", ret);
1005 	return ret;
1051 	int ret = 0;
1072 		ret = sdw_slave_clk_stop_callback(slave,
1075 		if (ret < 0 && ret != -ENODATA) {
1076 			dev_err(&slave->dev, "clock stop pre-prepare cb failed:%d\n", ret);
1077 			return ret;
1084 			ret = sdw_slave_clk_stop_prepare(slave,
1087 			if (ret < 0 && ret != -ENODATA) {
1088 				dev_err(&slave->dev, "clock stop prepare failed:%d\n", ret);
1089 				return ret;
1103 		ret = sdw_bus_wait_for_clk_prep_deprep(bus,
1111 		if (ret < 0)
1112 			return ret;
1124 		ret = sdw_slave_clk_stop_callback(slave,
1128 		if (ret < 0 && ret != -ENODATA) {
1129 			dev_err(&slave->dev, "clock stop post-prepare cb failed:%d\n", ret);
1130 			return ret;
1148 	int ret;
1154 	ret = sdw_bwrite_no_pm(bus, SDW_BROADCAST_DEV_NUM,
1156 	if (ret < 0) {
1157 		if (ret != -ENODATA)
1158 			dev_err(bus->dev, "ClockStopNow Broadcast msg failed %d\n", ret);
1159 		return ret;
1180 	int ret;
1198 		ret = sdw_slave_clk_stop_callback(slave, SDW_CLK_STOP_MODE0,
1200 		if (ret < 0)
1201 			dev_warn(&slave->dev, "clock stop pre-deprepare cb failed:%d\n", ret);
1207 			ret = sdw_slave_clk_stop_prepare(slave, SDW_CLK_STOP_MODE0,
1210 			if (ret < 0)
1211 				dev_warn(&slave->dev, "clock stop deprepare failed:%d\n", ret);
1224 		ret = sdw_bus_wait_for_clk_prep_deprep(bus, SDW_BROADCAST_DEV_NUM, false);
1225 		if (ret < 0)
1226 			dev_warn(bus->dev, "clock stop deprepare wait failed:%d\n", ret);
1237 		ret = sdw_slave_clk_stop_callback(slave, SDW_CLK_STOP_MODE0,
1239 		if (ret < 0)
1240 			dev_warn(&slave->dev, "clock stop post-deprepare cb failed:%d\n", ret);
1251 	int ret;
1271 	ret = sdw_update_no_pm(slave, addr, (mask | SDW_DPN_INT_PORT_READY), val);
1272 	if (ret < 0)
1276 	return ret;
1286 	int ret;
1357 	ret = sdw_write_no_pm(slave, SDW_SCP_BUS_CLOCK_BASE, base);
1358 	if (ret < 0) {
1360 			"SDW_SCP_BUS_CLOCK_BASE write failed:%d\n", ret);
1361 		return ret;
1365 	ret = sdw_write_no_pm(slave, SDW_SCP_BUSCLOCK_SCALE_B0, scale_index);
1366 	if (ret < 0) {
1368 			"SDW_SCP_BUSCLOCK_SCALE_B0 write failed:%d\n", ret);
1369 		return ret;
1371 	ret = sdw_write_no_pm(slave, SDW_SCP_BUSCLOCK_SCALE_B1, scale_index);
1372 	if (ret < 0)
1374 			"SDW_SCP_BUSCLOCK_SCALE_B1 write failed:%d\n", ret);
1380 	return ret;
1387 	int ret;
1390 	ret = sdw_slave_set_frequency(slave);
1391 	if (ret < 0)
1392 		return ret;
1404 			ret = sdw_write_no_pm(slave, SDW_SCP_INT1, SDW_SCP_INT1_BUS_CLASH);
1405 			if (ret < 0) {
1407 					"SDW_SCP_INT1 (BUS_CLASH) write failed:%d\n", ret);
1408 				return ret;
1423 			ret = sdw_write_no_pm(slave, SDW_SCP_INT1, SDW_SCP_INT1_PARITY);
1424 			if (ret < 0) {
1426 					"SDW_SCP_INT1 (PARITY) write failed:%d\n", ret);
1427 				return ret;
1442 	ret = sdw_update_no_pm(slave, SDW_SCP_INTMASK1, val, val);
1443 	if (ret < 0) {
1445 			"SDW_SCP_INTMASK1 write failed:%d\n", ret);
1446 		return ret;
1457 	ret = sdw_update_no_pm(slave, SDW_DP0_INTMASK, val, val);
1458 	if (ret < 0)
1460 			"SDW_DP0_INTMASK read failed:%d\n", ret);
1461 	return ret;
1467 	int status, status2, ret, count = 0;
1508 		ret = sdw_write_no_pm(slave, SDW_DP0_INT, clear);
1509 		if (ret < 0) {
1511 				"SDW_DP0_INT write failed:%d\n", ret);
1512 			return ret;
1533 	return ret;
1540 	int status, status2, ret, count = 0;
1581 		ret = sdw_write_no_pm(slave, addr, clear);
1582 		if (ret < 0) {
1584 				"SDW_DPN_INT write failed:%d\n", ret);
1585 			return ret;
1606 	return ret;
1613 	int port_num, stat, ret, count = 0;
1623 	ret = pm_runtime_get_sync(&slave->dev);
1624 	if (ret < 0 && ret != -EACCES) {
1625 		dev_err(&slave->dev, "Failed to resume device: %d\n", ret);
1627 		return ret;
1631 	ret = sdw_read_no_pm(slave, SDW_SCP_INT1);
1632 	if (ret < 0) {
1634 			"SDW_SCP_INT1 read failed:%d\n", ret);
1637 	buf = ret;
1639 	ret = sdw_nread_no_pm(slave, SDW_SCP_INTSTAT2, 2, buf2);
1640 	if (ret < 0) {
1642 			"SDW_SCP_INT2/3 read failed:%d\n", ret);
1647 		ret = sdw_read_no_pm(slave, SDW_DP0_INT);
1648 		if (ret < 0) {
1650 				"SDW_DP0_INT read failed:%d\n", ret);
1653 		sdca_cascade = ret & SDW_DP0_SDCA_CASCADE;
1757 		ret = sdw_write_no_pm(slave, SDW_SCP_INT1, clear);
1758 		if (ret < 0) {
1760 				"SDW_SCP_INT1 write failed:%d\n", ret);
1771 		ret = sdw_read_no_pm(slave, SDW_SCP_INT1);
1772 		if (ret < 0) {
1774 				"SDW_SCP_INT1 recheck read failed:%d\n", ret);
1777 		buf = ret;
1779 		ret = sdw_nread_no_pm(slave, SDW_SCP_INTSTAT2, 2, buf2);
1780 		if (ret < 0) {
1782 				"SDW_SCP_INT2/3 recheck read failed:%d\n", ret);
1787 			ret = sdw_read_no_pm(slave, SDW_DP0_INT);
1788 			if (ret < 0) {
1790 					"SDW_DP0_INT recheck read failed:%d\n", ret);
1793 			sdca_cascade = ret & SDW_DP0_SDCA_CASCADE;
1817 	return ret;
1823 	int ret = 0;
1832 			ret = drv->ops->update_status(slave, status);
1837 	return ret;
1851 	int i, ret = 0;
1873 			ret = sdw_update_slave_status(slave, status[i]);
1874 			if (ret < 0)
1875 				dev_warn(&slave->dev, "Update Slave status failed:%d\n", ret);
1927 			ret = sdw_handle_slave_alerts(slave);
1928 			if (ret < 0)
1931 					i, ret);
1946 			ret = sdw_initialize_slave(slave);
1947 			if (ret < 0)
1950 					i, ret);
1960 		ret = sdw_update_slave_status(slave, status[i]);
1961 		if (ret < 0)
1963 				"Update Slave status failed:%d\n", ret);
1985 	return ret;