Lines Matching +full:slave +full:- +full:mode
1 // SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause)
2 // Copyright(c) 2015-17 Intel Corporation.
22 bus->id = rc; in sdw_get_id()
27 * sdw_bus_master_add() - add a bus Master instance
43 return -ENODEV; in sdw_bus_master_add()
55 bus->link_id); in sdw_bus_master_add()
59 if (!bus->ops) { in sdw_bus_master_add()
60 dev_err(bus->dev, "SoundWire Bus ops are not set\n"); in sdw_bus_master_add()
61 return -EINVAL; in sdw_bus_master_add()
64 if (!bus->compute_params) { in sdw_bus_master_add()
65 dev_err(bus->dev, in sdw_bus_master_add()
67 return -EINVAL; in sdw_bus_master_add()
70 mutex_init(&bus->msg_lock); in sdw_bus_master_add()
71 mutex_init(&bus->bus_lock); in sdw_bus_master_add()
72 INIT_LIST_HEAD(&bus->slaves); in sdw_bus_master_add()
73 INIT_LIST_HEAD(&bus->m_rt_list); in sdw_bus_master_add()
79 bus->multi_link = false; in sdw_bus_master_add()
80 if (bus->ops->read_prop) { in sdw_bus_master_add()
81 ret = bus->ops->read_prop(bus); in sdw_bus_master_add()
83 dev_err(bus->dev, in sdw_bus_master_add()
99 *bus->assigned = ~GENMASK(SDW_BROADCAST_DEV_NUM, SDW_ENUM_DEV_NUM); in sdw_bus_master_add()
102 set_bit(SDW_ENUM_DEV_NUM, bus->assigned); in sdw_bus_master_add()
103 set_bit(SDW_BROADCAST_DEV_NUM, bus->assigned); in sdw_bus_master_add()
106 set_bit(SDW_GROUP12_DEV_NUM, bus->assigned); in sdw_bus_master_add()
107 set_bit(SDW_GROUP13_DEV_NUM, bus->assigned); in sdw_bus_master_add()
108 set_bit(SDW_MASTER_DEV_NUM, bus->assigned); in sdw_bus_master_add()
114 * Create Slave devices based on Slaves described in in sdw_bus_master_add()
117 if (IS_ENABLED(CONFIG_ACPI) && ACPI_HANDLE(bus->dev)) in sdw_bus_master_add()
119 else if (IS_ENABLED(CONFIG_OF) && bus->dev->of_node) in sdw_bus_master_add()
122 ret = -ENOTSUPP; /* No ACPI/DT so error out */ in sdw_bus_master_add()
125 dev_err(bus->dev, "Finding slaves failed:%d\n", ret); in sdw_bus_master_add()
138 prop = &bus->prop; in sdw_bus_master_add()
139 bus->params.max_dr_freq = prop->max_clk_freq * SDW_DOUBLE_RATE_FACTOR; in sdw_bus_master_add()
140 bus->params.curr_dr_freq = bus->params.max_dr_freq; in sdw_bus_master_add()
141 bus->params.curr_bank = SDW_BANK0; in sdw_bus_master_add()
142 bus->params.next_bank = SDW_BANK1; in sdw_bus_master_add()
150 struct sdw_slave *slave = dev_to_sdw_dev(dev); in sdw_delete_slave() local
151 struct sdw_bus *bus = slave->bus; in sdw_delete_slave()
155 sdw_slave_debugfs_exit(slave); in sdw_delete_slave()
157 mutex_lock(&bus->bus_lock); in sdw_delete_slave()
159 if (slave->dev_num) /* clear dev_num if assigned */ in sdw_delete_slave()
160 clear_bit(slave->dev_num, bus->assigned); in sdw_delete_slave()
162 list_del_init(&slave->node); in sdw_delete_slave()
163 mutex_unlock(&bus->bus_lock); in sdw_delete_slave()
170 * sdw_bus_master_delete() - delete the bus master instance
177 device_for_each_child(bus->dev, NULL, sdw_delete_slave); in sdw_bus_master_delete()
181 ida_free(&sdw_ida, bus->id); in sdw_bus_master_delete()
196 return -ENODATA; in find_response_code()
199 return -ETIMEDOUT; in find_response_code()
202 return -EIO; in find_response_code()
208 int retry = bus->prop.err_threshold; in do_transfer()
213 resp = bus->ops->xfer_msg(bus, msg); in do_transfer()
217 if (ret == 0 || ret == -ENODATA) in do_transfer()
228 int retry = bus->prop.err_threshold; in do_transfer_defer()
232 defer->msg = msg; in do_transfer_defer()
233 defer->length = msg->len; in do_transfer_defer()
234 init_completion(&defer->complete); in do_transfer_defer()
237 resp = bus->ops->xfer_msg_defer(bus, msg, defer); in do_transfer_defer()
240 if (ret == 0 || ret == -ENODATA) in do_transfer_defer()
249 int retry = bus->prop.err_threshold; in sdw_reset_page()
254 resp = bus->ops->reset_page_addr(bus, dev_num); in sdw_reset_page()
257 if (ret == 0 || ret == -ENODATA) in sdw_reset_page()
269 if (ret != 0 && ret != -ENODATA) in sdw_transfer_unlocked()
270 dev_err(bus->dev, "trf on Slave %d failed:%d\n", in sdw_transfer_unlocked()
271 msg->dev_num, ret); in sdw_transfer_unlocked()
273 if (msg->page) in sdw_transfer_unlocked()
274 sdw_reset_page(bus, msg->dev_num); in sdw_transfer_unlocked()
280 * sdw_transfer() - Synchronous transfer message to a SDW Slave device
288 mutex_lock(&bus->msg_lock); in sdw_transfer()
292 mutex_unlock(&bus->msg_lock); in sdw_transfer()
298 * sdw_transfer_defer() - Asynchronously transfer message to a SDW Slave device
310 if (!bus->ops->xfer_msg_defer) in sdw_transfer_defer()
311 return -ENOTSUPP; in sdw_transfer_defer()
314 if (ret != 0 && ret != -ENODATA) in sdw_transfer_defer()
315 dev_err(bus->dev, "Defer trf on Slave %d failed:%d\n", in sdw_transfer_defer()
316 msg->dev_num, ret); in sdw_transfer_defer()
318 if (msg->page) in sdw_transfer_defer()
319 sdw_reset_page(bus, msg->dev_num); in sdw_transfer_defer()
324 int sdw_fill_msg(struct sdw_msg *msg, struct sdw_slave *slave, in sdw_fill_msg() argument
328 msg->addr = addr; /* addr is 16 bit and truncated here */ in sdw_fill_msg()
329 msg->len = count; in sdw_fill_msg()
330 msg->dev_num = dev_num; in sdw_fill_msg()
331 msg->flags = flags; in sdw_fill_msg()
332 msg->buf = buf; in sdw_fill_msg()
339 return -EINVAL; in sdw_fill_msg()
343 if (slave && !slave->prop.paging_support) in sdw_fill_msg()
345 /* no need for else as that will fall-through to paging */ in sdw_fill_msg()
351 return -EINVAL; in sdw_fill_msg()
354 if (!slave) { in sdw_fill_msg()
355 pr_err("SDW: No slave for paging addr\n"); in sdw_fill_msg()
356 return -EINVAL; in sdw_fill_msg()
359 if (!slave->prop.paging_support) { in sdw_fill_msg()
360 dev_err(&slave->dev, in sdw_fill_msg()
362 return -EINVAL; in sdw_fill_msg()
365 msg->addr_page1 = FIELD_GET(SDW_SCP_ADDRPAGE1_MASK, addr); in sdw_fill_msg()
366 msg->addr_page2 = FIELD_GET(SDW_SCP_ADDRPAGE2_MASK, addr); in sdw_fill_msg()
367 msg->addr |= BIT(15); in sdw_fill_msg()
368 msg->page = true; in sdw_fill_msg()
376 * handling suspend-resume sequences.
381 sdw_nread_no_pm(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nread_no_pm() argument
386 ret = sdw_fill_msg(&msg, slave, addr, count, in sdw_nread_no_pm()
387 slave->dev_num, SDW_MSG_FLAG_READ, val); in sdw_nread_no_pm()
391 return sdw_transfer(slave->bus, &msg); in sdw_nread_no_pm()
395 sdw_nwrite_no_pm(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nwrite_no_pm() argument
400 ret = sdw_fill_msg(&msg, slave, addr, count, in sdw_nwrite_no_pm()
401 slave->dev_num, SDW_MSG_FLAG_WRITE, val); in sdw_nwrite_no_pm()
405 return sdw_transfer(slave->bus, &msg); in sdw_nwrite_no_pm()
408 int sdw_write_no_pm(struct sdw_slave *slave, u32 addr, u8 value) in sdw_write_no_pm() argument
410 return sdw_nwrite_no_pm(slave, addr, 1, &value); in sdw_write_no_pm()
480 int sdw_read_no_pm(struct sdw_slave *slave, u32 addr) in sdw_read_no_pm() argument
485 ret = sdw_nread_no_pm(slave, addr, 1, &buf); in sdw_read_no_pm()
493 static int sdw_update_no_pm(struct sdw_slave *slave, u32 addr, u8 mask, u8 val) in sdw_update_no_pm() argument
497 tmp = sdw_read_no_pm(slave, addr); in sdw_update_no_pm()
502 return sdw_write_no_pm(slave, addr, tmp); in sdw_update_no_pm()
506 * sdw_nread() - Read "n" contiguous SDW Slave registers
507 * @slave: SDW Slave
512 int sdw_nread(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nread() argument
516 ret = pm_runtime_get_sync(&slave->dev); in sdw_nread()
517 if (ret < 0 && ret != -EACCES) { in sdw_nread()
518 pm_runtime_put_noidle(&slave->dev); in sdw_nread()
522 ret = sdw_nread_no_pm(slave, addr, count, val); in sdw_nread()
524 pm_runtime_mark_last_busy(&slave->dev); in sdw_nread()
525 pm_runtime_put(&slave->dev); in sdw_nread()
532 * sdw_nwrite() - Write "n" contiguous SDW Slave registers
533 * @slave: SDW Slave
538 int sdw_nwrite(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nwrite() argument
542 ret = pm_runtime_get_sync(&slave->dev); in sdw_nwrite()
543 if (ret < 0 && ret != -EACCES) { in sdw_nwrite()
544 pm_runtime_put_noidle(&slave->dev); in sdw_nwrite()
548 ret = sdw_nwrite_no_pm(slave, addr, count, val); in sdw_nwrite()
550 pm_runtime_mark_last_busy(&slave->dev); in sdw_nwrite()
551 pm_runtime_put(&slave->dev); in sdw_nwrite()
558 * sdw_read() - Read a SDW Slave register
559 * @slave: SDW Slave
562 int sdw_read(struct sdw_slave *slave, u32 addr) in sdw_read() argument
567 ret = sdw_nread(slave, addr, 1, &buf); in sdw_read()
576 * sdw_write() - Write a SDW Slave register
577 * @slave: SDW Slave
581 int sdw_write(struct sdw_slave *slave, u32 addr, u8 value) in sdw_write() argument
583 return sdw_nwrite(slave, addr, 1, &value); in sdw_write()
594 struct sdw_slave *slave = NULL; in sdw_get_slave() local
596 list_for_each_entry(slave, &bus->slaves, node) { in sdw_get_slave()
597 if (slave->dev_num == i) in sdw_get_slave()
598 return slave; in sdw_get_slave()
604 static int sdw_compare_devid(struct sdw_slave *slave, struct sdw_slave_id id) in sdw_compare_devid() argument
606 if (slave->id.mfg_id != id.mfg_id || in sdw_compare_devid()
607 slave->id.part_id != id.part_id || in sdw_compare_devid()
608 slave->id.class_id != id.class_id || in sdw_compare_devid()
609 (slave->id.unique_id != SDW_IGNORED_UNIQUE_ID && in sdw_compare_devid()
610 slave->id.unique_id != id.unique_id)) in sdw_compare_devid()
611 return -ENODEV; in sdw_compare_devid()
617 static int sdw_get_device_num(struct sdw_slave *slave) in sdw_get_device_num() argument
621 bit = find_first_zero_bit(slave->bus->assigned, SDW_MAX_DEVICES); in sdw_get_device_num()
623 bit = -ENODEV; in sdw_get_device_num()
628 * Do not update dev_num in Slave data structure here, in sdw_get_device_num()
631 set_bit(bit, slave->bus->assigned); in sdw_get_device_num()
637 static int sdw_assign_device_num(struct sdw_slave *slave) in sdw_assign_device_num() argument
643 if (!slave->dev_num) { in sdw_assign_device_num()
644 if (!slave->dev_num_sticky) { in sdw_assign_device_num()
645 mutex_lock(&slave->bus->bus_lock); in sdw_assign_device_num()
646 dev_num = sdw_get_device_num(slave); in sdw_assign_device_num()
647 mutex_unlock(&slave->bus->bus_lock); in sdw_assign_device_num()
649 dev_err(slave->bus->dev, "Get dev_num failed: %d\n", in sdw_assign_device_num()
653 slave->dev_num = dev_num; in sdw_assign_device_num()
654 slave->dev_num_sticky = dev_num; in sdw_assign_device_num()
657 slave->dev_num = slave->dev_num_sticky; in sdw_assign_device_num()
662 dev_dbg(slave->bus->dev, in sdw_assign_device_num()
663 "Slave already registered, reusing dev_num:%d\n", in sdw_assign_device_num()
664 slave->dev_num); in sdw_assign_device_num()
666 /* Clear the slave->dev_num to transfer message on device 0 */ in sdw_assign_device_num()
667 dev_num = slave->dev_num; in sdw_assign_device_num()
668 slave->dev_num = 0; in sdw_assign_device_num()
670 ret = sdw_write_no_pm(slave, SDW_SCP_DEVNUMBER, dev_num); in sdw_assign_device_num()
672 dev_err(&slave->dev, "Program device_num %d failed: %d\n", in sdw_assign_device_num()
678 slave->dev_num = slave->dev_num_sticky; in sdw_assign_device_num()
686 dev_dbg(bus->dev, "SDW Slave Addr: %llx\n", addr); in sdw_extract_slave_id()
688 id->sdw_version = SDW_VERSION(addr); in sdw_extract_slave_id()
689 id->unique_id = SDW_UNIQUE_ID(addr); in sdw_extract_slave_id()
690 id->mfg_id = SDW_MFG_ID(addr); in sdw_extract_slave_id()
691 id->part_id = SDW_PART_ID(addr); in sdw_extract_slave_id()
692 id->class_id = SDW_CLASS_ID(addr); in sdw_extract_slave_id()
694 dev_dbg(bus->dev, in sdw_extract_slave_id()
695 "SDW Slave class_id %x, part_id %x, mfg_id %x, unique_id %x, version %x\n", in sdw_extract_slave_id()
696 id->class_id, id->part_id, id->mfg_id, in sdw_extract_slave_id()
697 id->unique_id, id->sdw_version); in sdw_extract_slave_id()
703 struct sdw_slave *slave, *_s; in sdw_program_device_num() local
710 /* No Slave, so use raw xfer api */ in sdw_program_device_num()
718 if (ret == -ENODATA) { /* end of device id reads */ in sdw_program_device_num()
719 dev_dbg(bus->dev, "No more devices to enumerate\n"); in sdw_program_device_num()
724 dev_err(bus->dev, "DEVID read fail:%d\n", ret); in sdw_program_device_num()
740 list_for_each_entry_safe(slave, _s, &bus->slaves, node) { in sdw_program_device_num()
741 if (sdw_compare_devid(slave, id) == 0) { in sdw_program_device_num()
745 * Assign a new dev_num to this Slave and in sdw_program_device_num()
750 ret = sdw_assign_device_num(slave); in sdw_program_device_num()
752 dev_err(slave->bus->dev, in sdw_program_device_num()
766 * add Slave device even if there is no platform in sdw_program_device_num()
773 dev_err(bus->dev, "Slave Entry not found\n"); in sdw_program_device_num()
789 static void sdw_modify_slave_status(struct sdw_slave *slave, in sdw_modify_slave_status() argument
792 mutex_lock(&slave->bus->bus_lock); in sdw_modify_slave_status()
794 dev_vdbg(&slave->dev, in sdw_modify_slave_status()
795 "%s: changing status slave %d status %d new status %d\n", in sdw_modify_slave_status()
796 __func__, slave->dev_num, slave->status, status); in sdw_modify_slave_status()
799 dev_dbg(&slave->dev, in sdw_modify_slave_status()
800 "%s: initializing enumeration and init completion for Slave %d\n", in sdw_modify_slave_status()
801 __func__, slave->dev_num); in sdw_modify_slave_status()
803 reinit_completion(&slave->enumeration_complete); in sdw_modify_slave_status()
804 reinit_completion(&slave->initialization_complete); in sdw_modify_slave_status()
807 (slave->status == SDW_SLAVE_UNATTACHED)) { in sdw_modify_slave_status()
808 dev_dbg(&slave->dev, in sdw_modify_slave_status()
809 "%s: signaling enumeration completion for Slave %d\n", in sdw_modify_slave_status()
810 __func__, slave->dev_num); in sdw_modify_slave_status()
812 complete_all(&slave->enumeration_complete); in sdw_modify_slave_status()
814 slave->status = status; in sdw_modify_slave_status()
815 mutex_unlock(&slave->bus->bus_lock); in sdw_modify_slave_status()
818 static enum sdw_clk_stop_mode sdw_get_clk_stop_mode(struct sdw_slave *slave) in sdw_get_clk_stop_mode() argument
820 enum sdw_clk_stop_mode mode; in sdw_get_clk_stop_mode() local
823 * Query for clock stop mode if Slave implements in sdw_get_clk_stop_mode()
824 * ops->get_clk_stop_mode, else read from property. in sdw_get_clk_stop_mode()
826 if (slave->ops && slave->ops->get_clk_stop_mode) { in sdw_get_clk_stop_mode()
827 mode = slave->ops->get_clk_stop_mode(slave); in sdw_get_clk_stop_mode()
829 if (slave->prop.clk_stop_mode1) in sdw_get_clk_stop_mode()
830 mode = SDW_CLK_STOP_MODE1; in sdw_get_clk_stop_mode()
832 mode = SDW_CLK_STOP_MODE0; in sdw_get_clk_stop_mode()
835 return mode; in sdw_get_clk_stop_mode()
838 static int sdw_slave_clk_stop_callback(struct sdw_slave *slave, in sdw_slave_clk_stop_callback() argument
839 enum sdw_clk_stop_mode mode, in sdw_slave_clk_stop_callback() argument
844 if (slave->ops && slave->ops->clk_stop) { in sdw_slave_clk_stop_callback()
845 ret = slave->ops->clk_stop(slave, mode, type); in sdw_slave_clk_stop_callback()
847 dev_err(&slave->dev, in sdw_slave_clk_stop_callback()
856 static int sdw_slave_clk_stop_prepare(struct sdw_slave *slave, in sdw_slave_clk_stop_prepare() argument
857 enum sdw_clk_stop_mode mode, in sdw_slave_clk_stop_prepare() argument
864 wake_en = slave->prop.wake_capable; in sdw_slave_clk_stop_prepare()
869 if (mode == SDW_CLK_STOP_MODE1) in sdw_slave_clk_stop_prepare()
875 val = sdw_read_no_pm(slave, SDW_SCP_SYSTEMCTRL); in sdw_slave_clk_stop_prepare()
880 ret = sdw_write_no_pm(slave, SDW_SCP_SYSTEMCTRL, val); in sdw_slave_clk_stop_prepare()
883 dev_err(&slave->dev, in sdw_slave_clk_stop_prepare()
884 "Clock Stop prepare failed for slave: %d", ret); in sdw_slave_clk_stop_prepare()
891 int retry = bus->clk_stop_timeout; in sdw_bus_wait_for_clk_prep_deprep()
898 dev_info(bus->dev, "clock stop prep/de-prep done slave:%d", in sdw_bus_wait_for_clk_prep_deprep()
904 retry--; in sdw_bus_wait_for_clk_prep_deprep()
907 dev_err(bus->dev, "clock stop prep/de-prep failed slave:%d", in sdw_bus_wait_for_clk_prep_deprep()
910 return -ETIMEDOUT; in sdw_bus_wait_for_clk_prep_deprep()
914 * sdw_bus_prep_clk_stop: prepare Slave(s) for clock stop
918 * Query Slave for clock stop mode and prepare for that mode.
924 struct sdw_slave *slave; in sdw_bus_prep_clk_stop() local
930 * each Slave and then wait for all Slave(s) to be in sdw_bus_prep_clk_stop()
933 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_prep_clk_stop()
934 if (!slave->dev_num) in sdw_bus_prep_clk_stop()
937 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_prep_clk_stop()
938 slave->status != SDW_SLAVE_ALERT) in sdw_bus_prep_clk_stop()
941 /* Identify if Slave(s) are available on Bus */ in sdw_bus_prep_clk_stop()
944 slave_mode = sdw_get_clk_stop_mode(slave); in sdw_bus_prep_clk_stop()
945 slave->curr_clk_stop_mode = slave_mode; in sdw_bus_prep_clk_stop()
947 ret = sdw_slave_clk_stop_callback(slave, slave_mode, in sdw_bus_prep_clk_stop()
950 dev_err(&slave->dev, in sdw_bus_prep_clk_stop()
951 "pre-prepare failed:%d", ret); in sdw_bus_prep_clk_stop()
955 ret = sdw_slave_clk_stop_prepare(slave, in sdw_bus_prep_clk_stop()
958 dev_err(&slave->dev, in sdw_bus_prep_clk_stop()
959 "pre-prepare failed:%d", ret); in sdw_bus_prep_clk_stop()
974 /* Don't need to inform slaves if there is no slave attached */ in sdw_bus_prep_clk_stop()
979 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_prep_clk_stop()
980 if (!slave->dev_num) in sdw_bus_prep_clk_stop()
983 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_prep_clk_stop()
984 slave->status != SDW_SLAVE_ALERT) in sdw_bus_prep_clk_stop()
987 slave_mode = slave->curr_clk_stop_mode; in sdw_bus_prep_clk_stop()
990 ret = sdw_slave_clk_stop_callback(slave, in sdw_bus_prep_clk_stop()
995 dev_err(&slave->dev, in sdw_bus_prep_clk_stop()
996 "post-prepare failed:%d", ret); in sdw_bus_prep_clk_stop()
1024 if (ret == -ENODATA) in sdw_bus_clk_stop()
1025 dev_dbg(bus->dev, in sdw_bus_clk_stop()
1028 dev_err(bus->dev, in sdw_bus_clk_stop()
1038 * sdw_bus_exit_clk_stop: Exit clock stop mode
1042 * This De-prepares the Slaves by exiting Clock Stop Mode 0. For the Slaves
1043 * exiting Clock Stop Mode 1, they will be de-prepared after they enumerate
1048 enum sdw_clk_stop_mode mode; in sdw_bus_exit_clk_stop() local
1050 struct sdw_slave *slave; in sdw_bus_exit_clk_stop() local
1055 * In order to save on transition time, de-prepare in sdw_bus_exit_clk_stop()
1056 * each Slave and then wait for all Slave(s) to be in sdw_bus_exit_clk_stop()
1057 * de-prepared after clock resume. in sdw_bus_exit_clk_stop()
1059 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_exit_clk_stop()
1060 if (!slave->dev_num) in sdw_bus_exit_clk_stop()
1063 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_exit_clk_stop()
1064 slave->status != SDW_SLAVE_ALERT) in sdw_bus_exit_clk_stop()
1067 /* Identify if Slave(s) are available on Bus */ in sdw_bus_exit_clk_stop()
1070 mode = slave->curr_clk_stop_mode; in sdw_bus_exit_clk_stop()
1072 if (mode == SDW_CLK_STOP_MODE1) { in sdw_bus_exit_clk_stop()
1077 ret = sdw_slave_clk_stop_callback(slave, mode, in sdw_bus_exit_clk_stop()
1080 dev_warn(&slave->dev, in sdw_bus_exit_clk_stop()
1083 ret = sdw_slave_clk_stop_prepare(slave, mode, in sdw_bus_exit_clk_stop()
1087 dev_warn(&slave->dev, in sdw_bus_exit_clk_stop()
1095 * Don't need to call slave callback function if there is no slave in sdw_bus_exit_clk_stop()
1101 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_exit_clk_stop()
1102 if (!slave->dev_num) in sdw_bus_exit_clk_stop()
1105 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_exit_clk_stop()
1106 slave->status != SDW_SLAVE_ALERT) in sdw_bus_exit_clk_stop()
1109 mode = slave->curr_clk_stop_mode; in sdw_bus_exit_clk_stop()
1110 sdw_slave_clk_stop_callback(slave, mode, in sdw_bus_exit_clk_stop()
1118 int sdw_configure_dpn_intr(struct sdw_slave *slave, in sdw_configure_dpn_intr() argument
1125 if (slave->bus->params.s_data_mode != SDW_PORT_DATA_MODE_NORMAL) { in sdw_configure_dpn_intr()
1126 dev_dbg(&slave->dev, "TEST FAIL interrupt %s\n", in sdw_configure_dpn_intr()
1142 ret = sdw_update(slave, addr, (mask | SDW_DPN_INT_PORT_READY), val); in sdw_configure_dpn_intr()
1144 dev_err(slave->bus->dev, in sdw_configure_dpn_intr()
1150 static int sdw_slave_set_frequency(struct sdw_slave *slave) in sdw_slave_set_frequency() argument
1152 u32 mclk_freq = slave->bus->prop.mclk_freq; in sdw_slave_set_frequency()
1153 u32 curr_freq = slave->bus->params.curr_dr_freq >> 1; in sdw_slave_set_frequency()
1161 * devices. They may also be used for 1.2+/non-SDCA devices, in sdw_slave_set_frequency()
1164 if (!slave->id.class_id) in sdw_slave_set_frequency()
1168 dev_err(&slave->dev, in sdw_slave_set_frequency()
1170 return -EINVAL; in sdw_slave_set_frequency()
1198 dev_err(&slave->dev, in sdw_slave_set_frequency()
1201 return -EINVAL; in sdw_slave_set_frequency()
1205 dev_err(&slave->dev, in sdw_slave_set_frequency()
1208 return -EINVAL; in sdw_slave_set_frequency()
1214 * map scale to Table 90 of SoundWire 1.2 spec - and check in sdw_slave_set_frequency()
1220 dev_err(&slave->dev, in sdw_slave_set_frequency()
1223 return -EINVAL; in sdw_slave_set_frequency()
1227 ret = sdw_write_no_pm(slave, SDW_SCP_BUS_CLOCK_BASE, base); in sdw_slave_set_frequency()
1229 dev_err(&slave->dev, in sdw_slave_set_frequency()
1235 ret = sdw_write_no_pm(slave, SDW_SCP_BUSCLOCK_SCALE_B0, scale_index); in sdw_slave_set_frequency()
1237 dev_err(&slave->dev, in sdw_slave_set_frequency()
1241 ret = sdw_write_no_pm(slave, SDW_SCP_BUSCLOCK_SCALE_B1, scale_index); in sdw_slave_set_frequency()
1243 dev_err(&slave->dev, in sdw_slave_set_frequency()
1246 dev_dbg(&slave->dev, in sdw_slave_set_frequency()
1253 static int sdw_initialize_slave(struct sdw_slave *slave) in sdw_initialize_slave() argument
1255 struct sdw_slave_prop *prop = &slave->prop; in sdw_initialize_slave()
1259 ret = sdw_slave_set_frequency(slave); in sdw_initialize_slave()
1265 * implementation-defined interrupt mask. The Parity detection in sdw_initialize_slave()
1267 * device-dependent, it might e.g. only be enabled in in sdw_initialize_slave()
1268 * steady-state after a couple of frames. in sdw_initialize_slave()
1270 val = slave->prop.scp_int1_mask; in sdw_initialize_slave()
1273 ret = sdw_update_no_pm(slave, SDW_SCP_INTMASK1, val, val); in sdw_initialize_slave()
1275 dev_err(slave->bus->dev, in sdw_initialize_slave()
1281 if (!slave->prop.dp0_prop) in sdw_initialize_slave()
1285 val = prop->dp0_prop->imp_def_interrupts; in sdw_initialize_slave()
1288 ret = sdw_update_no_pm(slave, SDW_DP0_INTMASK, val, val); in sdw_initialize_slave()
1290 dev_err(slave->bus->dev, in sdw_initialize_slave()
1295 static int sdw_handle_dp0_interrupt(struct sdw_slave *slave, u8 *slave_status) in sdw_handle_dp0_interrupt() argument
1300 status = sdw_read(slave, SDW_DP0_INT); in sdw_handle_dp0_interrupt()
1302 dev_err(slave->bus->dev, in sdw_handle_dp0_interrupt()
1309 dev_err(&slave->dev, "Test fail for port 0\n"); in sdw_handle_dp0_interrupt()
1319 complete(&slave->port_ready[0]); in sdw_handle_dp0_interrupt()
1324 dev_err(&slave->dev, "BRA failed\n"); in sdw_handle_dp0_interrupt()
1337 ret = sdw_write(slave, SDW_DP0_INT, clear); in sdw_handle_dp0_interrupt()
1339 dev_err(slave->bus->dev, in sdw_handle_dp0_interrupt()
1345 status2 = sdw_read(slave, SDW_DP0_INT); in sdw_handle_dp0_interrupt()
1347 dev_err(slave->bus->dev, in sdw_handle_dp0_interrupt()
1359 dev_warn(slave->bus->dev, "Reached MAX_RETRY on DP0 read\n"); in sdw_handle_dp0_interrupt()
1364 static int sdw_handle_port_interrupt(struct sdw_slave *slave, in sdw_handle_port_interrupt() argument
1372 return sdw_handle_dp0_interrupt(slave, slave_status); in sdw_handle_port_interrupt()
1375 status = sdw_read(slave, addr); in sdw_handle_port_interrupt()
1377 dev_err(slave->bus->dev, in sdw_handle_port_interrupt()
1385 dev_err(&slave->dev, "Test fail for port:%d\n", port); in sdw_handle_port_interrupt()
1394 complete(&slave->port_ready[port]); in sdw_handle_port_interrupt()
1407 ret = sdw_write(slave, addr, clear); in sdw_handle_port_interrupt()
1409 dev_err(slave->bus->dev, in sdw_handle_port_interrupt()
1415 status2 = sdw_read(slave, addr); in sdw_handle_port_interrupt()
1417 dev_err(slave->bus->dev, in sdw_handle_port_interrupt()
1429 dev_warn(slave->bus->dev, "Reached MAX_RETRY on port read"); in sdw_handle_port_interrupt()
1434 static int sdw_handle_slave_alerts(struct sdw_slave *slave) in sdw_handle_slave_alerts() argument
1445 sdw_modify_slave_status(slave, SDW_SLAVE_ALERT); in sdw_handle_slave_alerts()
1447 ret = pm_runtime_get_sync(&slave->dev); in sdw_handle_slave_alerts()
1448 if (ret < 0 && ret != -EACCES) { in sdw_handle_slave_alerts()
1449 dev_err(&slave->dev, "Failed to resume device: %d\n", ret); in sdw_handle_slave_alerts()
1450 pm_runtime_put_noidle(&slave->dev); in sdw_handle_slave_alerts()
1455 ret = sdw_read(slave, SDW_SCP_INT1); in sdw_handle_slave_alerts()
1457 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
1463 ret = sdw_nread(slave, SDW_SCP_INTSTAT2, 2, buf2); in sdw_handle_slave_alerts()
1465 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
1472 * Check parity, bus clash and Slave (impl defined) in sdw_handle_slave_alerts()
1476 parity_check = slave->prop.scp_int1_mask & SDW_SCP_INT1_PARITY; in sdw_handle_slave_alerts()
1477 parity_quirk = !slave->first_interrupt_done && in sdw_handle_slave_alerts()
1478 (slave->prop.quirks & SDW_SLAVE_QUIRKS_INVALID_INITIAL_PARITY); in sdw_handle_slave_alerts()
1481 dev_err(&slave->dev, "Parity error detected\n"); in sdw_handle_slave_alerts()
1486 if (slave->prop.scp_int1_mask & SDW_SCP_INT1_BUS_CLASH) in sdw_handle_slave_alerts()
1487 dev_err(&slave->dev, "Bus clash detected\n"); in sdw_handle_slave_alerts()
1499 if (slave->prop.scp_int1_mask & SDW_SCP_INT1_IMPL_DEF) { in sdw_handle_slave_alerts()
1500 dev_dbg(&slave->dev, "Slave impl defined interrupt\n"); in sdw_handle_slave_alerts()
1506 /* Check port 0 - 3 interrupts */ in sdw_handle_slave_alerts()
1512 sdw_handle_port_interrupt(slave, bit, in sdw_handle_slave_alerts()
1522 sdw_handle_port_interrupt(slave, in sdw_handle_slave_alerts()
1534 sdw_handle_port_interrupt(slave, in sdw_handle_slave_alerts()
1540 /* Update the Slave driver */ in sdw_handle_slave_alerts()
1541 if (slave_notify && slave->ops && in sdw_handle_slave_alerts()
1542 slave->ops->interrupt_callback) { in sdw_handle_slave_alerts()
1547 slave->ops->interrupt_callback(slave, &slave_intr); in sdw_handle_slave_alerts()
1551 ret = sdw_write(slave, SDW_SCP_INT1, clear); in sdw_handle_slave_alerts()
1553 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
1559 slave->first_interrupt_done = true; in sdw_handle_slave_alerts()
1565 ret = sdw_read(slave, SDW_SCP_INT1); in sdw_handle_slave_alerts()
1567 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
1573 ret = sdw_nread(slave, SDW_SCP_INTSTAT2, 2, _buf2); in sdw_handle_slave_alerts()
1575 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
1587 * Exit loop if Slave is continuously in ALERT state even in sdw_handle_slave_alerts()
1596 dev_warn(slave->bus->dev, "Reached MAX_RETRY on alert read\n"); in sdw_handle_slave_alerts()
1599 pm_runtime_mark_last_busy(&slave->dev); in sdw_handle_slave_alerts()
1600 pm_runtime_put_autosuspend(&slave->dev); in sdw_handle_slave_alerts()
1605 static int sdw_update_slave_status(struct sdw_slave *slave, in sdw_update_slave_status() argument
1610 if (!slave->probed) { in sdw_update_slave_status()
1612 * the slave status update is typically handled in an in sdw_update_slave_status()
1619 time = wait_for_completion_timeout(&slave->probe_complete, in sdw_update_slave_status()
1622 dev_err(&slave->dev, "Probe not complete, timed out\n"); in sdw_update_slave_status()
1623 return -ETIMEDOUT; in sdw_update_slave_status()
1627 if (!slave->ops || !slave->ops->update_status) in sdw_update_slave_status()
1630 return slave->ops->update_status(slave, status); in sdw_update_slave_status()
1634 * sdw_handle_slave_status() - Handle Slave status
1636 * @status: Status for all Slave(s)
1642 struct sdw_slave *slave; in sdw_handle_slave_status() local
1648 mutex_lock(&bus->bus_lock); in sdw_handle_slave_status()
1649 if (test_bit(i, bus->assigned) == false) { in sdw_handle_slave_status()
1650 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
1653 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
1655 slave = sdw_get_slave(bus, i); in sdw_handle_slave_status()
1656 if (!slave) in sdw_handle_slave_status()
1660 slave->status != SDW_SLAVE_UNATTACHED) in sdw_handle_slave_status()
1661 sdw_modify_slave_status(slave, SDW_SLAVE_UNATTACHED); in sdw_handle_slave_status()
1665 dev_dbg(bus->dev, "Slave attached, programming device number\n"); in sdw_handle_slave_status()
1668 dev_err(bus->dev, "Slave attach failed: %d\n", ret); in sdw_handle_slave_status()
1676 /* Continue to check other slave statuses */ in sdw_handle_slave_status()
1678 mutex_lock(&bus->bus_lock); in sdw_handle_slave_status()
1679 if (test_bit(i, bus->assigned) == false) { in sdw_handle_slave_status()
1680 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
1683 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
1685 slave = sdw_get_slave(bus, i); in sdw_handle_slave_status()
1686 if (!slave) in sdw_handle_slave_status()
1693 if (slave->status == SDW_SLAVE_UNATTACHED) in sdw_handle_slave_status()
1696 sdw_modify_slave_status(slave, SDW_SLAVE_UNATTACHED); in sdw_handle_slave_status()
1700 ret = sdw_handle_slave_alerts(slave); in sdw_handle_slave_status()
1702 dev_err(bus->dev, in sdw_handle_slave_status()
1703 "Slave %d alert handling failed: %d\n", in sdw_handle_slave_status()
1708 if (slave->status == SDW_SLAVE_ATTACHED) in sdw_handle_slave_status()
1711 prev_status = slave->status; in sdw_handle_slave_status()
1712 sdw_modify_slave_status(slave, SDW_SLAVE_ATTACHED); in sdw_handle_slave_status()
1719 ret = sdw_initialize_slave(slave); in sdw_handle_slave_status()
1721 dev_err(bus->dev, in sdw_handle_slave_status()
1722 "Slave %d initialization failed: %d\n", in sdw_handle_slave_status()
1728 dev_err(bus->dev, "Invalid slave %d status:%d\n", in sdw_handle_slave_status()
1733 ret = sdw_update_slave_status(slave, status[i]); in sdw_handle_slave_status()
1735 dev_err(slave->bus->dev, in sdw_handle_slave_status()
1736 "Update Slave status failed:%d\n", ret); in sdw_handle_slave_status()
1738 dev_dbg(&slave->dev, in sdw_handle_slave_status()
1739 "%s: signaling initialization completion for Slave %d\n", in sdw_handle_slave_status()
1740 __func__, slave->dev_num); in sdw_handle_slave_status()
1742 complete_all(&slave->initialization_complete); in sdw_handle_slave_status()
1751 * This would be a no-op in case the peripheral was being resumed in sdw_handle_slave_status()
1754 pm_request_resume(&slave->dev); in sdw_handle_slave_status()
1764 struct sdw_slave *slave; in sdw_clear_slave_status() local
1767 /* Check all non-zero devices */ in sdw_clear_slave_status()
1769 mutex_lock(&bus->bus_lock); in sdw_clear_slave_status()
1770 if (test_bit(i, bus->assigned) == false) { in sdw_clear_slave_status()
1771 mutex_unlock(&bus->bus_lock); in sdw_clear_slave_status()
1774 mutex_unlock(&bus->bus_lock); in sdw_clear_slave_status()
1776 slave = sdw_get_slave(bus, i); in sdw_clear_slave_status()
1777 if (!slave) in sdw_clear_slave_status()
1780 if (slave->status != SDW_SLAVE_UNATTACHED) { in sdw_clear_slave_status()
1781 sdw_modify_slave_status(slave, SDW_SLAVE_UNATTACHED); in sdw_clear_slave_status()
1782 slave->first_interrupt_done = false; in sdw_clear_slave_status()
1786 slave->unattach_request = request; in sdw_clear_slave_status()