drivers/soundwire/amd_manager.c

21 #include "bus.h"
27 #define to_amd_sdw(b)	container_of(b, struct amd_sdw_manager, bus)
40 	/* SoundWire manager bus reset */
316 static enum sdw_command_response amd_sdw_xfer_msg(struct sdw_bus *bus, struct sdw_msg *msg)
318 	struct amd_sdw_manager *amd_manager = to_amd_sdw(bus);
367 	mutex_lock(&amd_manager->bus.msg_lock);
369 	mutex_unlock(&amd_manager->bus.msg_lock);
373 static u32 amd_sdw_read_ping_status(struct sdw_bus *bus)
375 	struct amd_sdw_manager *amd_manager = to_amd_sdw(bus);
387 static int amd_sdw_compute_params(struct sdw_bus *bus)
392 	struct sdw_bus_params *b_params = &bus->params;
398 	hstop = bus->params.col - 1;
402 	list_for_each_entry(m_rt, &bus->m_rt_list, bus_node) {
405 		sample_int = (bus->params.curr_dr_freq / rate);
408 			dev_dbg(bus->dev, "p_rt->num=%d hstart=%d hstop=%d port_bo=%d\n",
429 static int amd_sdw_port_params(struct sdw_bus *bus, struct sdw_port_params *p_params,
432 	struct amd_sdw_manager *amd_manager = to_amd_sdw(bus);
455 static int amd_sdw_transport_params(struct sdw_bus *bus,
459 	struct amd_sdw_manager *amd_manager = to_amd_sdw(bus);
515 static int amd_sdw_port_enable(struct sdw_bus *bus,
519 	struct amd_sdw_manager *amd_manager = to_amd_sdw(bus);
547 static int sdw_master_read_amd_prop(struct sdw_bus *bus)
549 	struct amd_sdw_manager *amd_manager = to_amd_sdw(bus);
557 	prop = &bus->prop;
559 	snprintf(name, sizeof(name), "mipi-sdw-link-%d-subproperties", bus->link_id);
560 	link = device_get_named_child_node(bus->dev, name);
562 		dev_err(bus->dev, "Manager node %s not found\n", name);
578 static int amd_prop_read(struct sdw_bus *bus)
580 	sdw_master_read_prop(bus);
581 	sdw_master_read_amd_prop(bus);
635 	ret = sdw_stream_add_master(&amd_manager->bus, &sconfig,
655 	ret = sdw_stream_remove_master(&amd_manager->bus, dai_runtime->stream);
681 		dai_runtime->bus = &amd_manager->bus;
781 	sdw_handle_slave_status(&amd_manager->bus, amd_manager->status);
867 	prop = &amd_manager->bus.prop;
917 	amd_manager->bus.ops = &amd_sdw_ops;
918 	amd_manager->bus.port_ops = &amd_sdw_port_ops;
919 	amd_manager->bus.compute_params = &amd_sdw_compute_params;
920 	amd_manager->bus.clk_stop_timeout = 200;
921 	amd_manager->bus.link_id = amd_manager->instance;
929 	amd_manager->bus.controller_id = 0;
944 	params = &amd_manager->bus.params;
948 	prop = &amd_manager->bus.prop;
953 	ret = sdw_bus_master_add(&amd_manager->bus, dev, dev->fwnode);
961 		sdw_bus_master_delete(&amd_manager->bus);
977 	sdw_bus_master_delete(&amd_manager->bus);
988 	ret = sdw_bus_prep_clk_stop(&amd_manager->bus);
993 	ret = sdw_bus_clk_stop(&amd_manager->bus);
995 		dev_err(amd_manager->dev, "bus clock stop failed %d", ret);
1028 			ret = sdw_bus_exit_clk_stop(&amd_manager->bus);
1030 				dev_err(amd_manager->dev, "bus failed to exit clock stop %d\n",
1053 		dev_dbg(dev, "skipping device, never detected on bus\n");
1067 	struct sdw_bus *bus = &amd_manager->bus;
1070 	if (bus->prop.hw_disabled) {
1071 		dev_dbg(bus->dev, "SoundWire manager %d is disabled, ignoring\n",
1072 			bus->link_id);
1083 			dev_err(bus->dev, "pm_request_resume failed: %d\n", ret);
1092 	ret = device_for_each_child(bus->dev, NULL, amd_resume_child_device);
1101 	struct sdw_bus *bus = &amd_manager->bus;
1104 	if (bus->prop.hw_disabled) {
1105 		dev_dbg(bus->dev, "SoundWire manager %d is disabled, ignoring\n",
1106 			bus->link_id);
1129 	struct sdw_bus *bus = &amd_manager->bus;
1132 	if (bus->prop.hw_disabled) {
1133 		dev_dbg(bus->dev, "SoundWire manager %d is disabled,\n",
1134 			bus->link_id);
1152 	struct sdw_bus *bus = &amd_manager->bus;
1156 	if (bus->prop.hw_disabled) {
1157 		dev_dbg(bus->dev, "SoundWire manager %d is disabled, ignoring\n",
1158 			bus->link_id);
1177 		sdw_clear_slave_status(bus, SDW_UNATTACH_REQUEST_MASTER_RESET);