Lines Matching +full:slave +full:- +full:addr
1 // SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause)
2 // Copyright(c) 2015-17 Intel Corporation.
25 bus->id = rc; in sdw_get_id()
27 if (bus->controller_id == -1) in sdw_get_id()
28 bus->controller_id = rc; in sdw_get_id()
34 * sdw_bus_master_add() - add a bus Master instance
50 return -ENODEV; in sdw_bus_master_add()
59 ida_init(&bus->slave_ida); in sdw_bus_master_add()
64 bus->link_id); in sdw_bus_master_add()
68 if (!bus->ops) { in sdw_bus_master_add()
69 dev_err(bus->dev, "SoundWire Bus ops are not set\n"); in sdw_bus_master_add()
70 return -EINVAL; in sdw_bus_master_add()
73 if (!bus->compute_params) { in sdw_bus_master_add()
74 dev_err(bus->dev, in sdw_bus_master_add()
76 return -EINVAL; in sdw_bus_master_add()
82 * grabbed during configuration of a multi-bus stream. in sdw_bus_master_add()
84 lockdep_register_key(&bus->msg_lock_key); in sdw_bus_master_add()
85 __mutex_init(&bus->msg_lock, "msg_lock", &bus->msg_lock_key); in sdw_bus_master_add()
87 lockdep_register_key(&bus->bus_lock_key); in sdw_bus_master_add()
88 __mutex_init(&bus->bus_lock, "bus_lock", &bus->bus_lock_key); in sdw_bus_master_add()
90 INIT_LIST_HEAD(&bus->slaves); in sdw_bus_master_add()
91 INIT_LIST_HEAD(&bus->m_rt_list); in sdw_bus_master_add()
96 bus->multi_link = false; in sdw_bus_master_add()
97 if (bus->ops->read_prop) { in sdw_bus_master_add()
98 ret = bus->ops->read_prop(bus); in sdw_bus_master_add()
100 dev_err(bus->dev, in sdw_bus_master_add()
116 *bus->assigned = ~GENMASK(SDW_BROADCAST_DEV_NUM, SDW_ENUM_DEV_NUM); in sdw_bus_master_add()
119 set_bit(SDW_ENUM_DEV_NUM, bus->assigned); in sdw_bus_master_add()
120 set_bit(SDW_BROADCAST_DEV_NUM, bus->assigned); in sdw_bus_master_add()
123 set_bit(SDW_GROUP12_DEV_NUM, bus->assigned); in sdw_bus_master_add()
124 set_bit(SDW_GROUP13_DEV_NUM, bus->assigned); in sdw_bus_master_add()
125 set_bit(SDW_MASTER_DEV_NUM, bus->assigned); in sdw_bus_master_add()
135 * Create Slave devices based on Slaves described in in sdw_bus_master_add()
138 if (IS_ENABLED(CONFIG_ACPI) && ACPI_HANDLE(bus->dev)) in sdw_bus_master_add()
140 else if (IS_ENABLED(CONFIG_OF) && bus->dev->of_node) in sdw_bus_master_add()
143 ret = -ENOTSUPP; /* No ACPI/DT so error out */ in sdw_bus_master_add()
146 dev_err(bus->dev, "Finding slaves failed:%d\n", ret); in sdw_bus_master_add()
160 prop = &bus->prop; in sdw_bus_master_add()
161 bus->params.max_dr_freq = prop->max_clk_freq * SDW_DOUBLE_RATE_FACTOR; in sdw_bus_master_add()
162 bus->params.curr_dr_freq = bus->params.max_dr_freq; in sdw_bus_master_add()
163 bus->params.curr_bank = SDW_BANK0; in sdw_bus_master_add()
164 bus->params.next_bank = SDW_BANK1; in sdw_bus_master_add()
172 struct sdw_slave *slave = dev_to_sdw_dev(dev); in sdw_delete_slave() local
173 struct sdw_bus *bus = slave->bus; in sdw_delete_slave()
177 sdw_slave_debugfs_exit(slave); in sdw_delete_slave()
179 mutex_lock(&bus->bus_lock); in sdw_delete_slave()
181 if (slave->dev_num) { /* clear dev_num if assigned */ in sdw_delete_slave()
182 clear_bit(slave->dev_num, bus->assigned); in sdw_delete_slave()
183 if (bus->ops && bus->ops->put_device_num) in sdw_delete_slave()
184 bus->ops->put_device_num(bus, slave); in sdw_delete_slave()
186 list_del_init(&slave->node); in sdw_delete_slave()
187 mutex_unlock(&bus->bus_lock); in sdw_delete_slave()
194 * sdw_bus_master_delete() - delete the bus master instance
201 device_for_each_child(bus->dev, NULL, sdw_delete_slave); in sdw_bus_master_delete()
208 lockdep_unregister_key(&bus->bus_lock_key); in sdw_bus_master_delete()
209 lockdep_unregister_key(&bus->msg_lock_key); in sdw_bus_master_delete()
210 ida_free(&sdw_bus_ida, bus->id); in sdw_bus_master_delete()
225 return -ENODATA; in find_response_code()
228 return -ETIMEDOUT; in find_response_code()
231 return -EIO; in find_response_code()
237 int retry = bus->prop.err_threshold; in do_transfer()
242 resp = bus->ops->xfer_msg(bus, msg); in do_transfer()
246 if (ret == 0 || ret == -ENODATA) in do_transfer()
256 struct sdw_defer *defer = &bus->defer_msg; in do_transfer_defer()
257 int retry = bus->prop.err_threshold; in do_transfer_defer()
261 defer->msg = msg; in do_transfer_defer()
262 defer->length = msg->len; in do_transfer_defer()
263 init_completion(&defer->complete); in do_transfer_defer()
266 resp = bus->ops->xfer_msg_defer(bus); in do_transfer_defer()
269 if (ret == 0 || ret == -ENODATA) in do_transfer_defer()
281 if (ret != 0 && ret != -ENODATA) in sdw_transfer_unlocked()
282 dev_err(bus->dev, "trf on Slave %d failed:%d %s addr %x count %d\n", in sdw_transfer_unlocked()
283 msg->dev_num, ret, in sdw_transfer_unlocked()
284 str_write_read(msg->flags & SDW_MSG_FLAG_WRITE), in sdw_transfer_unlocked()
285 msg->addr, msg->len); in sdw_transfer_unlocked()
291 * sdw_transfer() - Synchronous transfer message to a SDW Slave device
299 mutex_lock(&bus->msg_lock); in sdw_transfer()
303 mutex_unlock(&bus->msg_lock); in sdw_transfer()
309 * sdw_show_ping_status() - Direct report of PING status, to be used by Peripheral drivers
317 if (!bus->ops->read_ping_status) in sdw_show_ping_status()
321 * wait for peripheral to sync if desired. 10-15ms should be more than in sdw_show_ping_status()
327 mutex_lock(&bus->msg_lock); in sdw_show_ping_status()
329 status = bus->ops->read_ping_status(bus); in sdw_show_ping_status()
331 mutex_unlock(&bus->msg_lock); in sdw_show_ping_status()
334 dev_warn(bus->dev, "%s: no peripherals attached\n", __func__); in sdw_show_ping_status()
336 dev_dbg(bus->dev, "PING status: %#x\n", status); in sdw_show_ping_status()
341 * sdw_transfer_defer() - Asynchronously transfer message to a SDW Slave device
351 if (!bus->ops->xfer_msg_defer) in sdw_transfer_defer()
352 return -ENOTSUPP; in sdw_transfer_defer()
355 if (ret != 0 && ret != -ENODATA) in sdw_transfer_defer()
356 dev_err(bus->dev, "Defer trf on Slave %d failed:%d\n", in sdw_transfer_defer()
357 msg->dev_num, ret); in sdw_transfer_defer()
362 int sdw_fill_msg(struct sdw_msg *msg, struct sdw_slave *slave, in sdw_fill_msg() argument
363 u32 addr, size_t count, u16 dev_num, u8 flags, u8 *buf) in sdw_fill_msg() argument
366 msg->addr = addr; /* addr is 16 bit and truncated here */ in sdw_fill_msg()
367 msg->len = count; in sdw_fill_msg()
368 msg->dev_num = dev_num; in sdw_fill_msg()
369 msg->flags = flags; in sdw_fill_msg()
370 msg->buf = buf; in sdw_fill_msg()
372 if (addr < SDW_REG_NO_PAGE) /* no paging area */ in sdw_fill_msg()
375 if (addr >= SDW_REG_MAX) { /* illegal addr */ in sdw_fill_msg()
376 pr_err("SDW: Invalid address %x passed\n", addr); in sdw_fill_msg()
377 return -EINVAL; in sdw_fill_msg()
380 if (addr < SDW_REG_OPTIONAL_PAGE) { /* 32k but no page */ in sdw_fill_msg()
381 if (slave && !slave->prop.paging_support) in sdw_fill_msg()
383 /* no need for else as that will fall-through to paging */ in sdw_fill_msg()
389 return -EINVAL; in sdw_fill_msg()
392 if (!slave) { in sdw_fill_msg()
393 pr_err("SDW: No slave for paging addr\n"); in sdw_fill_msg()
394 return -EINVAL; in sdw_fill_msg()
397 if (!slave->prop.paging_support) { in sdw_fill_msg()
398 dev_err(&slave->dev, in sdw_fill_msg()
399 "address %x needs paging but no support\n", addr); in sdw_fill_msg()
400 return -EINVAL; in sdw_fill_msg()
403 msg->addr_page1 = FIELD_GET(SDW_SCP_ADDRPAGE1_MASK, addr); in sdw_fill_msg()
404 msg->addr_page2 = FIELD_GET(SDW_SCP_ADDRPAGE2_MASK, addr); in sdw_fill_msg()
405 msg->addr |= BIT(15); in sdw_fill_msg()
406 msg->page = true; in sdw_fill_msg()
415 static int sdw_ntransfer_no_pm(struct sdw_slave *slave, u32 addr, u8 flags, in sdw_ntransfer_no_pm() argument
424 size = min_t(size_t, count, (SDW_REGADDR + 1) - (addr & SDW_REGADDR)); in sdw_ntransfer_no_pm()
426 ret = sdw_fill_msg(&msg, slave, addr, size, slave->dev_num, flags, val); in sdw_ntransfer_no_pm()
430 ret = sdw_transfer(slave->bus, &msg); in sdw_ntransfer_no_pm()
431 if (ret < 0 && !slave->is_mockup_device) in sdw_ntransfer_no_pm()
434 addr += size; in sdw_ntransfer_no_pm()
436 count -= size; in sdw_ntransfer_no_pm()
443 * sdw_nread_no_pm() - Read "n" contiguous SDW Slave registers with no PM
444 * @slave: SDW Slave
445 * @addr: Register address
452 int sdw_nread_no_pm(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nread_no_pm() argument
454 return sdw_ntransfer_no_pm(slave, addr, SDW_MSG_FLAG_READ, count, val); in sdw_nread_no_pm()
459 * sdw_nwrite_no_pm() - Write "n" contiguous SDW Slave registers with no PM
460 * @slave: SDW Slave
461 * @addr: Register address
468 int sdw_nwrite_no_pm(struct sdw_slave *slave, u32 addr, size_t count, const u8 *val) in sdw_nwrite_no_pm() argument
470 return sdw_ntransfer_no_pm(slave, addr, SDW_MSG_FLAG_WRITE, count, (u8 *)val); in sdw_nwrite_no_pm()
475 * sdw_write_no_pm() - Write a SDW Slave register with no PM
476 * @slave: SDW Slave
477 * @addr: Register address
480 int sdw_write_no_pm(struct sdw_slave *slave, u32 addr, u8 value) in sdw_write_no_pm() argument
482 return sdw_nwrite_no_pm(slave, addr, 1, &value); in sdw_write_no_pm()
487 sdw_bread_no_pm(struct sdw_bus *bus, u16 dev_num, u32 addr) in sdw_bread_no_pm() argument
493 ret = sdw_fill_msg(&msg, NULL, addr, 1, dev_num, in sdw_bread_no_pm()
506 sdw_bwrite_no_pm(struct sdw_bus *bus, u16 dev_num, u32 addr, u8 value) in sdw_bwrite_no_pm() argument
511 ret = sdw_fill_msg(&msg, NULL, addr, 1, dev_num, in sdw_bwrite_no_pm()
519 int sdw_bread_no_pm_unlocked(struct sdw_bus *bus, u16 dev_num, u32 addr) in sdw_bread_no_pm_unlocked() argument
525 ret = sdw_fill_msg(&msg, NULL, addr, 1, dev_num, in sdw_bread_no_pm_unlocked()
538 int sdw_bwrite_no_pm_unlocked(struct sdw_bus *bus, u16 dev_num, u32 addr, u8 value) in sdw_bwrite_no_pm_unlocked() argument
543 ret = sdw_fill_msg(&msg, NULL, addr, 1, dev_num, in sdw_bwrite_no_pm_unlocked()
553 * sdw_read_no_pm() - Read a SDW Slave register with no PM
554 * @slave: SDW Slave
555 * @addr: Register address
557 int sdw_read_no_pm(struct sdw_slave *slave, u32 addr) in sdw_read_no_pm() argument
562 ret = sdw_nread_no_pm(slave, addr, 1, &buf); in sdw_read_no_pm()
570 int sdw_update_no_pm(struct sdw_slave *slave, u32 addr, u8 mask, u8 val) in sdw_update_no_pm() argument
574 tmp = sdw_read_no_pm(slave, addr); in sdw_update_no_pm()
579 return sdw_write_no_pm(slave, addr, tmp); in sdw_update_no_pm()
583 /* Read-Modify-Write Slave register */
584 int sdw_update(struct sdw_slave *slave, u32 addr, u8 mask, u8 val) in sdw_update() argument
588 tmp = sdw_read(slave, addr); in sdw_update()
593 return sdw_write(slave, addr, tmp); in sdw_update()
598 * sdw_nread() - Read "n" contiguous SDW Slave registers
599 * @slave: SDW Slave
600 * @addr: Register address
604 * This version of the function will take a PM reference to the slave
609 int sdw_nread(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nread() argument
613 ret = pm_runtime_get_sync(&slave->dev); in sdw_nread()
614 if (ret < 0 && ret != -EACCES) { in sdw_nread()
615 pm_runtime_put_noidle(&slave->dev); in sdw_nread()
619 ret = sdw_nread_no_pm(slave, addr, count, val); in sdw_nread()
621 pm_runtime_mark_last_busy(&slave->dev); in sdw_nread()
622 pm_runtime_put(&slave->dev); in sdw_nread()
629 * sdw_nwrite() - Write "n" contiguous SDW Slave registers
630 * @slave: SDW Slave
631 * @addr: Register address
635 * This version of the function will take a PM reference to the slave
640 int sdw_nwrite(struct sdw_slave *slave, u32 addr, size_t count, const u8 *val) in sdw_nwrite() argument
644 ret = pm_runtime_get_sync(&slave->dev); in sdw_nwrite()
645 if (ret < 0 && ret != -EACCES) { in sdw_nwrite()
646 pm_runtime_put_noidle(&slave->dev); in sdw_nwrite()
650 ret = sdw_nwrite_no_pm(slave, addr, count, val); in sdw_nwrite()
652 pm_runtime_mark_last_busy(&slave->dev); in sdw_nwrite()
653 pm_runtime_put(&slave->dev); in sdw_nwrite()
660 * sdw_read() - Read a SDW Slave register
661 * @slave: SDW Slave
662 * @addr: Register address
664 * This version of the function will take a PM reference to the slave
667 int sdw_read(struct sdw_slave *slave, u32 addr) in sdw_read() argument
672 ret = sdw_nread(slave, addr, 1, &buf); in sdw_read()
681 * sdw_write() - Write a SDW Slave register
682 * @slave: SDW Slave
683 * @addr: Register address
686 * This version of the function will take a PM reference to the slave
689 int sdw_write(struct sdw_slave *slave, u32 addr, u8 value) in sdw_write() argument
691 return sdw_nwrite(slave, addr, 1, &value); in sdw_write()
702 struct sdw_slave *slave; in sdw_get_slave() local
704 list_for_each_entry(slave, &bus->slaves, node) { in sdw_get_slave()
705 if (slave->dev_num == i) in sdw_get_slave()
706 return slave; in sdw_get_slave()
712 int sdw_compare_devid(struct sdw_slave *slave, struct sdw_slave_id id) in sdw_compare_devid() argument
714 if (slave->id.mfg_id != id.mfg_id || in sdw_compare_devid()
715 slave->id.part_id != id.part_id || in sdw_compare_devid()
716 slave->id.class_id != id.class_id || in sdw_compare_devid()
717 (slave->id.unique_id != SDW_IGNORED_UNIQUE_ID && in sdw_compare_devid()
718 slave->id.unique_id != id.unique_id)) in sdw_compare_devid()
719 return -ENODEV; in sdw_compare_devid()
726 static int sdw_get_device_num(struct sdw_slave *slave) in sdw_get_device_num() argument
728 struct sdw_bus *bus = slave->bus; in sdw_get_device_num()
731 if (bus->ops && bus->ops->get_device_num) { in sdw_get_device_num()
732 bit = bus->ops->get_device_num(bus, slave); in sdw_get_device_num()
736 bit = find_first_zero_bit(bus->assigned, SDW_MAX_DEVICES); in sdw_get_device_num()
738 bit = -ENODEV; in sdw_get_device_num()
744 * Do not update dev_num in Slave data structure here, in sdw_get_device_num()
747 set_bit(bit, bus->assigned); in sdw_get_device_num()
753 static int sdw_assign_device_num(struct sdw_slave *slave) in sdw_assign_device_num() argument
755 struct sdw_bus *bus = slave->bus; in sdw_assign_device_num()
756 struct device *dev = bus->dev; in sdw_assign_device_num()
760 if (!slave->dev_num) { in sdw_assign_device_num()
761 if (!slave->dev_num_sticky) { in sdw_assign_device_num()
764 mutex_lock(&slave->bus->bus_lock); in sdw_assign_device_num()
765 dev_num = sdw_get_device_num(slave); in sdw_assign_device_num()
766 mutex_unlock(&slave->bus->bus_lock); in sdw_assign_device_num()
772 slave->dev_num_sticky = dev_num; in sdw_assign_device_num()
774 dev_dbg(dev, "Slave already registered, reusing dev_num: %d\n", in sdw_assign_device_num()
775 slave->dev_num_sticky); in sdw_assign_device_num()
779 /* Clear the slave->dev_num to transfer message on device 0 */ in sdw_assign_device_num()
780 slave->dev_num = 0; in sdw_assign_device_num()
782 ret = sdw_write_no_pm(slave, SDW_SCP_DEVNUMBER, slave->dev_num_sticky); in sdw_assign_device_num()
785 slave->dev_num_sticky, ret); in sdw_assign_device_num()
790 slave->dev_num = slave->dev_num_sticky; in sdw_assign_device_num()
792 if (bus->ops && bus->ops->new_peripheral_assigned) in sdw_assign_device_num()
793 bus->ops->new_peripheral_assigned(bus, slave, slave->dev_num); in sdw_assign_device_num()
799 u64 addr, struct sdw_slave_id *id) in sdw_extract_slave_id() argument
801 dev_dbg(bus->dev, "SDW Slave Addr: %llx\n", addr); in sdw_extract_slave_id()
803 id->sdw_version = SDW_VERSION(addr); in sdw_extract_slave_id()
804 id->unique_id = SDW_UNIQUE_ID(addr); in sdw_extract_slave_id()
805 id->mfg_id = SDW_MFG_ID(addr); in sdw_extract_slave_id()
806 id->part_id = SDW_PART_ID(addr); in sdw_extract_slave_id()
807 id->class_id = SDW_CLASS_ID(addr); in sdw_extract_slave_id()
809 dev_dbg(bus->dev, in sdw_extract_slave_id()
810 "SDW Slave class_id 0x%02x, mfg_id 0x%04x, part_id 0x%04x, unique_id 0x%x, version 0x%x\n", in sdw_extract_slave_id()
811 id->class_id, id->mfg_id, id->part_id, id->unique_id, id->sdw_version); in sdw_extract_slave_id()
815 bool is_clock_scaling_supported_by_slave(struct sdw_slave *slave) in is_clock_scaling_supported_by_slave() argument
821 return slave->id.class_id; in is_clock_scaling_supported_by_slave()
828 struct sdw_slave *slave, *_s; in sdw_program_device_num() local
833 u64 addr; in sdw_program_device_num() local
837 /* No Slave, so use raw xfer api */ in sdw_program_device_num()
845 if (ret == -ENODATA) { /* end of device id reads */ in sdw_program_device_num()
846 dev_dbg(bus->dev, "No more devices to enumerate\n"); in sdw_program_device_num()
851 dev_err(bus->dev, "DEVID read fail:%d\n", ret); in sdw_program_device_num()
856 * Construct the addr and extract. Cast the higher shift in sdw_program_device_num()
859 addr = buf[5] | (buf[4] << 8) | (buf[3] << 16) | in sdw_program_device_num()
863 sdw_extract_slave_id(bus, addr, &id); in sdw_program_device_num()
867 list_for_each_entry_safe(slave, _s, &bus->slaves, node) { in sdw_program_device_num()
868 if (sdw_compare_devid(slave, id) == 0) { in sdw_program_device_num()
872 * To prevent skipping state-machine stages don't in sdw_program_device_num()
878 if (slave->status != SDW_SLAVE_UNATTACHED) in sdw_program_device_num()
882 * Assign a new dev_num to this Slave and in sdw_program_device_num()
887 ret = sdw_assign_device_num(slave); in sdw_program_device_num()
889 dev_err(bus->dev, in sdw_program_device_num()
905 * add Slave device even if there is no platform in sdw_program_device_num()
912 dev_err(bus->dev, "Slave Entry not found\n"); in sdw_program_device_num()
928 static void sdw_modify_slave_status(struct sdw_slave *slave, in sdw_modify_slave_status() argument
931 struct sdw_bus *bus = slave->bus; in sdw_modify_slave_status()
933 mutex_lock(&bus->bus_lock); in sdw_modify_slave_status()
935 dev_vdbg(bus->dev, in sdw_modify_slave_status()
936 "changing status slave %d status %d new status %d\n", in sdw_modify_slave_status()
937 slave->dev_num, slave->status, status); in sdw_modify_slave_status()
940 dev_dbg(&slave->dev, in sdw_modify_slave_status()
941 "initializing enumeration and init completion for Slave %d\n", in sdw_modify_slave_status()
942 slave->dev_num); in sdw_modify_slave_status()
944 reinit_completion(&slave->enumeration_complete); in sdw_modify_slave_status()
945 reinit_completion(&slave->initialization_complete); in sdw_modify_slave_status()
948 (slave->status == SDW_SLAVE_UNATTACHED)) { in sdw_modify_slave_status()
949 dev_dbg(&slave->dev, in sdw_modify_slave_status()
950 "signaling enumeration completion for Slave %d\n", in sdw_modify_slave_status()
951 slave->dev_num); in sdw_modify_slave_status()
953 complete_all(&slave->enumeration_complete); in sdw_modify_slave_status()
955 slave->status = status; in sdw_modify_slave_status()
956 mutex_unlock(&bus->bus_lock); in sdw_modify_slave_status()
959 static int sdw_slave_clk_stop_callback(struct sdw_slave *slave, in sdw_slave_clk_stop_callback() argument
965 mutex_lock(&slave->sdw_dev_lock); in sdw_slave_clk_stop_callback()
967 if (slave->probed) { in sdw_slave_clk_stop_callback()
968 struct device *dev = &slave->dev; in sdw_slave_clk_stop_callback()
969 struct sdw_driver *drv = drv_to_sdw_driver(dev->driver); in sdw_slave_clk_stop_callback()
971 if (drv->ops && drv->ops->clk_stop) in sdw_slave_clk_stop_callback()
972 ret = drv->ops->clk_stop(slave, mode, type); in sdw_slave_clk_stop_callback()
975 mutex_unlock(&slave->sdw_dev_lock); in sdw_slave_clk_stop_callback()
980 static int sdw_slave_clk_stop_prepare(struct sdw_slave *slave, in sdw_slave_clk_stop_prepare() argument
988 wake_en = slave->prop.wake_capable; in sdw_slave_clk_stop_prepare()
999 ret = sdw_read_no_pm(slave, SDW_SCP_SYSTEMCTRL); in sdw_slave_clk_stop_prepare()
1001 if (ret != -ENODATA) in sdw_slave_clk_stop_prepare()
1002 dev_err(&slave->dev, "SDW_SCP_SYSTEMCTRL read failed:%d\n", ret); in sdw_slave_clk_stop_prepare()
1009 ret = sdw_write_no_pm(slave, SDW_SCP_SYSTEMCTRL, val); in sdw_slave_clk_stop_prepare()
1011 if (ret < 0 && ret != -ENODATA) in sdw_slave_clk_stop_prepare()
1012 dev_err(&slave->dev, "SDW_SCP_SYSTEMCTRL write failed:%d\n", ret); in sdw_slave_clk_stop_prepare()
1019 int retry = bus->clk_stop_timeout; in sdw_bus_wait_for_clk_prep_deprep()
1025 if (val != -ENODATA) in sdw_bus_wait_for_clk_prep_deprep()
1026 dev_err(bus->dev, "SDW_SCP_STAT bread failed:%d\n", val); in sdw_bus_wait_for_clk_prep_deprep()
1031 dev_dbg(bus->dev, "clock stop %s done slave:%d\n", in sdw_bus_wait_for_clk_prep_deprep()
1038 retry--; in sdw_bus_wait_for_clk_prep_deprep()
1041 dev_dbg(bus->dev, "clock stop %s did not complete for slave:%d\n", in sdw_bus_wait_for_clk_prep_deprep()
1045 return -ETIMEDOUT; in sdw_bus_wait_for_clk_prep_deprep()
1049 * sdw_bus_prep_clk_stop: prepare Slave(s) for clock stop
1053 * Query Slave for clock stop mode and prepare for that mode.
1058 struct sdw_slave *slave; in sdw_bus_prep_clk_stop() local
1064 * each Slave and then wait for all Slave(s) to be in sdw_bus_prep_clk_stop()
1066 * If one of the Slave devices has lost sync and in sdw_bus_prep_clk_stop()
1067 * replies with Command Ignored/-ENODATA, we continue in sdw_bus_prep_clk_stop()
1070 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_prep_clk_stop()
1071 if (!slave->dev_num) in sdw_bus_prep_clk_stop()
1074 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_prep_clk_stop()
1075 slave->status != SDW_SLAVE_ALERT) in sdw_bus_prep_clk_stop()
1078 /* Identify if Slave(s) are available on Bus */ in sdw_bus_prep_clk_stop()
1081 ret = sdw_slave_clk_stop_callback(slave, in sdw_bus_prep_clk_stop()
1084 if (ret < 0 && ret != -ENODATA) { in sdw_bus_prep_clk_stop()
1085 dev_err(&slave->dev, "clock stop pre-prepare cb failed:%d\n", ret); in sdw_bus_prep_clk_stop()
1089 /* Only prepare a Slave device if needed */ in sdw_bus_prep_clk_stop()
1090 if (!slave->prop.simple_clk_stop_capable) { in sdw_bus_prep_clk_stop()
1093 ret = sdw_slave_clk_stop_prepare(slave, in sdw_bus_prep_clk_stop()
1096 if (ret < 0 && ret != -ENODATA) { in sdw_bus_prep_clk_stop()
1097 dev_err(&slave->dev, "clock stop prepare failed:%d\n", ret); in sdw_bus_prep_clk_stop()
1103 /* Skip remaining clock stop preparation if no Slave is attached */ in sdw_bus_prep_clk_stop()
1115 * if there are no Slave devices present and the reply is in sdw_bus_prep_clk_stop()
1116 * Command_Ignored/-ENODATA, we don't need to continue with the in sdw_bus_prep_clk_stop()
1125 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_prep_clk_stop()
1126 if (!slave->dev_num) in sdw_bus_prep_clk_stop()
1129 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_prep_clk_stop()
1130 slave->status != SDW_SLAVE_ALERT) in sdw_bus_prep_clk_stop()
1133 ret = sdw_slave_clk_stop_callback(slave, in sdw_bus_prep_clk_stop()
1137 if (ret < 0 && ret != -ENODATA) { in sdw_bus_prep_clk_stop()
1138 dev_err(&slave->dev, "clock stop post-prepare cb failed:%d\n", ret); in sdw_bus_prep_clk_stop()
1166 if (ret != -ENODATA) in sdw_bus_clk_stop()
1167 dev_err(bus->dev, "ClockStopNow Broadcast msg failed %d\n", ret); in sdw_bus_clk_stop()
1180 * This De-prepares the Slaves by exiting Clock Stop Mode 0. For the Slaves
1181 * exiting Clock Stop Mode 1, they will be de-prepared after they enumerate
1187 struct sdw_slave *slave; in sdw_bus_exit_clk_stop() local
1192 * In order to save on transition time, de-prepare in sdw_bus_exit_clk_stop()
1193 * each Slave and then wait for all Slave(s) to be in sdw_bus_exit_clk_stop()
1194 * de-prepared after clock resume. in sdw_bus_exit_clk_stop()
1196 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_exit_clk_stop()
1197 if (!slave->dev_num) in sdw_bus_exit_clk_stop()
1200 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_exit_clk_stop()
1201 slave->status != SDW_SLAVE_ALERT) in sdw_bus_exit_clk_stop()
1204 /* Identify if Slave(s) are available on Bus */ in sdw_bus_exit_clk_stop()
1207 ret = sdw_slave_clk_stop_callback(slave, SDW_CLK_STOP_MODE0, in sdw_bus_exit_clk_stop()
1210 dev_warn(&slave->dev, "clock stop pre-deprepare cb failed:%d\n", ret); in sdw_bus_exit_clk_stop()
1212 /* Only de-prepare a Slave device if needed */ in sdw_bus_exit_clk_stop()
1213 if (!slave->prop.simple_clk_stop_capable) { in sdw_bus_exit_clk_stop()
1216 ret = sdw_slave_clk_stop_prepare(slave, SDW_CLK_STOP_MODE0, in sdw_bus_exit_clk_stop()
1220 dev_warn(&slave->dev, "clock stop deprepare failed:%d\n", ret); in sdw_bus_exit_clk_stop()
1224 /* Skip remaining clock stop de-preparation if no Slave is attached */ in sdw_bus_exit_clk_stop()
1235 dev_warn(bus->dev, "clock stop deprepare wait failed:%d\n", ret); in sdw_bus_exit_clk_stop()
1238 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_exit_clk_stop()
1239 if (!slave->dev_num) in sdw_bus_exit_clk_stop()
1242 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_exit_clk_stop()
1243 slave->status != SDW_SLAVE_ALERT) in sdw_bus_exit_clk_stop()
1246 ret = sdw_slave_clk_stop_callback(slave, SDW_CLK_STOP_MODE0, in sdw_bus_exit_clk_stop()
1249 dev_warn(&slave->dev, "clock stop post-deprepare cb failed:%d\n", ret); in sdw_bus_exit_clk_stop()
1256 int sdw_configure_dpn_intr(struct sdw_slave *slave, in sdw_configure_dpn_intr() argument
1259 u32 addr; in sdw_configure_dpn_intr() local
1263 if (slave->bus->params.s_data_mode != SDW_PORT_DATA_MODE_NORMAL) { in sdw_configure_dpn_intr()
1264 dev_dbg(&slave->dev, "TEST FAIL interrupt %s\n", in sdw_configure_dpn_intr()
1269 addr = SDW_DPN_INTMASK(port); in sdw_configure_dpn_intr()
1280 ret = sdw_update_no_pm(slave, addr, (mask | SDW_DPN_INT_PORT_READY), val); in sdw_configure_dpn_intr()
1282 dev_err(&slave->dev, in sdw_configure_dpn_intr()
1288 int sdw_slave_get_scale_index(struct sdw_slave *slave, u8 *base) in sdw_slave_get_scale_index() argument
1290 u32 mclk_freq = slave->bus->prop.mclk_freq; in sdw_slave_get_scale_index()
1291 u32 curr_freq = slave->bus->params.curr_dr_freq >> 1; in sdw_slave_get_scale_index()
1296 dev_err(&slave->dev, in sdw_slave_get_scale_index()
1298 return -EINVAL; in sdw_slave_get_scale_index()
1326 dev_err(&slave->dev, in sdw_slave_get_scale_index()
1329 return -EINVAL; in sdw_slave_get_scale_index()
1333 dev_err(&slave->dev, in sdw_slave_get_scale_index()
1336 return -EINVAL; in sdw_slave_get_scale_index()
1342 * map scale to Table 90 of SoundWire 1.2 spec - and check in sdw_slave_get_scale_index()
1348 dev_err(&slave->dev, in sdw_slave_get_scale_index()
1351 return -EINVAL; in sdw_slave_get_scale_index()
1355 dev_dbg(&slave->dev, in sdw_slave_get_scale_index()
1363 int sdw_slave_get_current_bank(struct sdw_slave *slave) in sdw_slave_get_current_bank() argument
1367 tmp = sdw_read(slave, SDW_SCP_CTRL); in sdw_slave_get_current_bank()
1375 static int sdw_slave_set_frequency(struct sdw_slave *slave) in sdw_slave_set_frequency() argument
1383 * devices. They may also be used for 1.2+/non-SDCA devices. in sdw_slave_set_frequency()
1388 if (!slave->id.class_id && !slave->prop.clock_reg_supported) in sdw_slave_set_frequency()
1391 scale_index = sdw_slave_get_scale_index(slave, &base); in sdw_slave_set_frequency()
1395 ret = sdw_write_no_pm(slave, SDW_SCP_BUS_CLOCK_BASE, base); in sdw_slave_set_frequency()
1397 dev_err(&slave->dev, in sdw_slave_set_frequency()
1403 ret = sdw_write_no_pm(slave, SDW_SCP_BUSCLOCK_SCALE_B0, scale_index); in sdw_slave_set_frequency()
1405 dev_err(&slave->dev, in sdw_slave_set_frequency()
1409 ret = sdw_write_no_pm(slave, SDW_SCP_BUSCLOCK_SCALE_B1, scale_index); in sdw_slave_set_frequency()
1411 dev_err(&slave->dev, in sdw_slave_set_frequency()
1417 static int sdw_initialize_slave(struct sdw_slave *slave) in sdw_initialize_slave() argument
1419 struct sdw_slave_prop *prop = &slave->prop; in sdw_initialize_slave()
1424 ret = sdw_slave_set_frequency(slave); in sdw_initialize_slave()
1428 if (slave->bus->prop.quirks & SDW_MASTER_QUIRKS_CLEAR_INITIAL_CLASH) { in sdw_initialize_slave()
1430 status = sdw_read_no_pm(slave, SDW_SCP_INT1); in sdw_initialize_slave()
1432 dev_err(&slave->dev, in sdw_initialize_slave()
1437 dev_warn(&slave->dev, "Bus clash detected before INT mask is enabled\n"); in sdw_initialize_slave()
1438 ret = sdw_write_no_pm(slave, SDW_SCP_INT1, SDW_SCP_INT1_BUS_CLASH); in sdw_initialize_slave()
1440 dev_err(&slave->dev, in sdw_initialize_slave()
1446 if ((slave->bus->prop.quirks & SDW_MASTER_QUIRKS_CLEAR_INITIAL_PARITY) && in sdw_initialize_slave()
1447 !(prop->quirks & SDW_SLAVE_QUIRKS_INVALID_INITIAL_PARITY)) { in sdw_initialize_slave()
1449 status = sdw_read_no_pm(slave, SDW_SCP_INT1); in sdw_initialize_slave()
1451 dev_err(&slave->dev, in sdw_initialize_slave()
1456 dev_warn(&slave->dev, "PARITY error detected before INT mask is enabled\n"); in sdw_initialize_slave()
1457 ret = sdw_write_no_pm(slave, SDW_SCP_INT1, SDW_SCP_INT1_PARITY); in sdw_initialize_slave()
1459 dev_err(&slave->dev, in sdw_initialize_slave()
1468 * implementation-defined interrupt mask. The Parity detection in sdw_initialize_slave()
1470 * device-dependent, it might e.g. only be enabled in in sdw_initialize_slave()
1471 * steady-state after a couple of frames. in sdw_initialize_slave()
1473 val = prop->scp_int1_mask; in sdw_initialize_slave()
1476 ret = sdw_update_no_pm(slave, SDW_SCP_INTMASK1, val, val); in sdw_initialize_slave()
1478 dev_err(&slave->dev, in sdw_initialize_slave()
1484 if (!prop->dp0_prop) in sdw_initialize_slave()
1488 val = prop->dp0_prop->imp_def_interrupts; in sdw_initialize_slave()
1491 ret = sdw_update_no_pm(slave, SDW_DP0_INTMASK, val, val); in sdw_initialize_slave()
1493 dev_err(&slave->dev, in sdw_initialize_slave()
1498 static int sdw_handle_dp0_interrupt(struct sdw_slave *slave, u8 *slave_status) in sdw_handle_dp0_interrupt() argument
1503 status = sdw_read_no_pm(slave, SDW_DP0_INT); in sdw_handle_dp0_interrupt()
1505 dev_err(&slave->dev, in sdw_handle_dp0_interrupt()
1514 dev_err(&slave->dev, "Test fail for port 0\n"); in sdw_handle_dp0_interrupt()
1524 complete(&slave->port_ready[0]); in sdw_handle_dp0_interrupt()
1529 dev_err(&slave->dev, "BRA failed\n"); in sdw_handle_dp0_interrupt()
1542 ret = sdw_write_no_pm(slave, SDW_DP0_INT, clear); in sdw_handle_dp0_interrupt()
1544 dev_err(&slave->dev, in sdw_handle_dp0_interrupt()
1550 status2 = sdw_read_no_pm(slave, SDW_DP0_INT); in sdw_handle_dp0_interrupt()
1552 dev_err(&slave->dev, in sdw_handle_dp0_interrupt()
1565 dev_warn(&slave->dev, "Reached MAX_RETRY on DP0 read\n"); in sdw_handle_dp0_interrupt()
1570 static int sdw_handle_port_interrupt(struct sdw_slave *slave, in sdw_handle_port_interrupt() argument
1575 u32 addr; in sdw_handle_port_interrupt() local
1578 return sdw_handle_dp0_interrupt(slave, slave_status); in sdw_handle_port_interrupt()
1580 addr = SDW_DPN_INT(port); in sdw_handle_port_interrupt()
1581 status = sdw_read_no_pm(slave, addr); in sdw_handle_port_interrupt()
1583 dev_err(&slave->dev, in sdw_handle_port_interrupt()
1593 dev_err(&slave->dev, "Test fail for port:%d\n", port); in sdw_handle_port_interrupt()
1602 complete(&slave->port_ready[port]); in sdw_handle_port_interrupt()
1615 ret = sdw_write_no_pm(slave, addr, clear); in sdw_handle_port_interrupt()
1617 dev_err(&slave->dev, in sdw_handle_port_interrupt()
1623 status2 = sdw_read_no_pm(slave, addr); in sdw_handle_port_interrupt()
1625 dev_err(&slave->dev, in sdw_handle_port_interrupt()
1638 dev_warn(&slave->dev, "Reached MAX_RETRY on port read"); in sdw_handle_port_interrupt()
1643 static int sdw_handle_slave_alerts(struct sdw_slave *slave) in sdw_handle_slave_alerts() argument
1655 sdw_modify_slave_status(slave, SDW_SLAVE_ALERT); in sdw_handle_slave_alerts()
1657 ret = pm_runtime_get_sync(&slave->dev); in sdw_handle_slave_alerts()
1658 if (ret < 0 && ret != -EACCES) { in sdw_handle_slave_alerts()
1659 dev_err(&slave->dev, "Failed to resume device: %d\n", ret); in sdw_handle_slave_alerts()
1660 pm_runtime_put_noidle(&slave->dev); in sdw_handle_slave_alerts()
1665 ret = sdw_read_no_pm(slave, SDW_SCP_INT1); in sdw_handle_slave_alerts()
1667 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1673 ret = sdw_nread_no_pm(slave, SDW_SCP_INTSTAT2, 2, buf2); in sdw_handle_slave_alerts()
1675 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1680 if (slave->id.class_id) { in sdw_handle_slave_alerts()
1681 ret = sdw_read_no_pm(slave, SDW_DP0_INT); in sdw_handle_slave_alerts()
1683 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1694 * Check parity, bus clash and Slave (impl defined) in sdw_handle_slave_alerts()
1698 parity_check = slave->prop.scp_int1_mask & SDW_SCP_INT1_PARITY; in sdw_handle_slave_alerts()
1699 parity_quirk = !slave->first_interrupt_done && in sdw_handle_slave_alerts()
1700 (slave->prop.quirks & SDW_SLAVE_QUIRKS_INVALID_INITIAL_PARITY); in sdw_handle_slave_alerts()
1703 dev_err(&slave->dev, "Parity error detected\n"); in sdw_handle_slave_alerts()
1708 if (slave->prop.scp_int1_mask & SDW_SCP_INT1_BUS_CLASH) in sdw_handle_slave_alerts()
1709 dev_err(&slave->dev, "Bus clash detected\n"); in sdw_handle_slave_alerts()
1721 if (slave->prop.scp_int1_mask & SDW_SCP_INT1_IMPL_DEF) { in sdw_handle_slave_alerts()
1722 dev_dbg(&slave->dev, "Slave impl defined interrupt\n"); in sdw_handle_slave_alerts()
1732 /* Check port 0 - 3 interrupts */ in sdw_handle_slave_alerts()
1738 sdw_handle_port_interrupt(slave, bit, in sdw_handle_slave_alerts()
1748 sdw_handle_port_interrupt(slave, in sdw_handle_slave_alerts()
1760 sdw_handle_port_interrupt(slave, in sdw_handle_slave_alerts()
1766 /* Update the Slave driver */ in sdw_handle_slave_alerts()
1768 if (slave->prop.use_domain_irq && slave->irq) in sdw_handle_slave_alerts()
1769 handle_nested_irq(slave->irq); in sdw_handle_slave_alerts()
1771 mutex_lock(&slave->sdw_dev_lock); in sdw_handle_slave_alerts()
1773 if (slave->probed) { in sdw_handle_slave_alerts()
1774 struct device *dev = &slave->dev; in sdw_handle_slave_alerts()
1775 struct sdw_driver *drv = drv_to_sdw_driver(dev->driver); in sdw_handle_slave_alerts()
1777 if (drv->ops && drv->ops->interrupt_callback) { in sdw_handle_slave_alerts()
1783 drv->ops->interrupt_callback(slave, &slave_intr); in sdw_handle_slave_alerts()
1787 mutex_unlock(&slave->sdw_dev_lock); in sdw_handle_slave_alerts()
1791 ret = sdw_write_no_pm(slave, SDW_SCP_INT1, clear); in sdw_handle_slave_alerts()
1793 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1799 slave->first_interrupt_done = true; in sdw_handle_slave_alerts()
1805 ret = sdw_read_no_pm(slave, SDW_SCP_INT1); in sdw_handle_slave_alerts()
1807 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1813 ret = sdw_nread_no_pm(slave, SDW_SCP_INTSTAT2, 2, buf2); in sdw_handle_slave_alerts()
1815 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1820 if (slave->id.class_id) { in sdw_handle_slave_alerts()
1821 ret = sdw_read_no_pm(slave, SDW_DP0_INT); in sdw_handle_slave_alerts()
1823 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1836 * Exit loop if Slave is continuously in ALERT state even in sdw_handle_slave_alerts()
1845 dev_warn(&slave->dev, "Reached MAX_RETRY on alert read\n"); in sdw_handle_slave_alerts()
1848 pm_runtime_mark_last_busy(&slave->dev); in sdw_handle_slave_alerts()
1849 pm_runtime_put_autosuspend(&slave->dev); in sdw_handle_slave_alerts()
1854 static int sdw_update_slave_status(struct sdw_slave *slave, in sdw_update_slave_status() argument
1859 mutex_lock(&slave->sdw_dev_lock); in sdw_update_slave_status()
1861 if (slave->probed) { in sdw_update_slave_status()
1862 struct device *dev = &slave->dev; in sdw_update_slave_status()
1863 struct sdw_driver *drv = drv_to_sdw_driver(dev->driver); in sdw_update_slave_status()
1865 if (drv->ops && drv->ops->update_status) in sdw_update_slave_status()
1866 ret = drv->ops->update_status(slave, status); in sdw_update_slave_status()
1869 mutex_unlock(&slave->sdw_dev_lock); in sdw_update_slave_status()
1875 * sdw_handle_slave_status() - Handle Slave status
1877 * @status: Status for all Slave(s)
1883 struct sdw_slave *slave; in sdw_handle_slave_status() local
1889 mutex_lock(&bus->bus_lock); in sdw_handle_slave_status()
1890 if (test_bit(i, bus->assigned) == false) { in sdw_handle_slave_status()
1891 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
1894 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
1896 slave = sdw_get_slave(bus, i); in sdw_handle_slave_status()
1897 if (!slave) in sdw_handle_slave_status()
1901 slave->status != SDW_SLAVE_UNATTACHED) { in sdw_handle_slave_status()
1902 dev_warn(&slave->dev, "Slave %d state check1: UNATTACHED, status was %d\n", in sdw_handle_slave_status()
1903 i, slave->status); in sdw_handle_slave_status()
1904 sdw_modify_slave_status(slave, SDW_SLAVE_UNATTACHED); in sdw_handle_slave_status()
1907 ret = sdw_update_slave_status(slave, status[i]); in sdw_handle_slave_status()
1909 dev_warn(&slave->dev, "Update Slave status failed:%d\n", ret); in sdw_handle_slave_status()
1914 dev_dbg(bus->dev, "Slave attached, programming device number\n"); in sdw_handle_slave_status()
1934 /* Continue to check other slave statuses */ in sdw_handle_slave_status()
1936 mutex_lock(&bus->bus_lock); in sdw_handle_slave_status()
1937 if (test_bit(i, bus->assigned) == false) { in sdw_handle_slave_status()
1938 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
1941 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
1943 slave = sdw_get_slave(bus, i); in sdw_handle_slave_status()
1944 if (!slave) in sdw_handle_slave_status()
1951 if (slave->status == SDW_SLAVE_UNATTACHED) in sdw_handle_slave_status()
1954 dev_warn(&slave->dev, "Slave %d state check2: UNATTACHED, status was %d\n", in sdw_handle_slave_status()
1955 i, slave->status); in sdw_handle_slave_status()
1957 sdw_modify_slave_status(slave, SDW_SLAVE_UNATTACHED); in sdw_handle_slave_status()
1961 ret = sdw_handle_slave_alerts(slave); in sdw_handle_slave_status()
1963 dev_err(&slave->dev, in sdw_handle_slave_status()
1964 "Slave %d alert handling failed: %d\n", in sdw_handle_slave_status()
1969 if (slave->status == SDW_SLAVE_ATTACHED) in sdw_handle_slave_status()
1972 prev_status = slave->status; in sdw_handle_slave_status()
1973 sdw_modify_slave_status(slave, SDW_SLAVE_ATTACHED); in sdw_handle_slave_status()
1980 ret = sdw_initialize_slave(slave); in sdw_handle_slave_status()
1982 dev_err(&slave->dev, in sdw_handle_slave_status()
1983 "Slave %d initialization failed: %d\n", in sdw_handle_slave_status()
1989 dev_err(&slave->dev, "Invalid slave %d status:%d\n", in sdw_handle_slave_status()
1994 ret = sdw_update_slave_status(slave, status[i]); in sdw_handle_slave_status()
1996 dev_err(&slave->dev, in sdw_handle_slave_status()
1997 "Update Slave status failed:%d\n", ret); in sdw_handle_slave_status()
1999 dev_dbg(&slave->dev, in sdw_handle_slave_status()
2000 "signaling initialization completion for Slave %d\n", in sdw_handle_slave_status()
2001 slave->dev_num); in sdw_handle_slave_status()
2003 complete_all(&slave->initialization_complete); in sdw_handle_slave_status()
2012 * This would be a no-op in case the peripheral was being resumed in sdw_handle_slave_status()
2015 pm_request_resume(&slave->dev); in sdw_handle_slave_status()
2025 struct sdw_slave *slave; in sdw_clear_slave_status() local
2028 /* Check all non-zero devices */ in sdw_clear_slave_status()
2030 mutex_lock(&bus->bus_lock); in sdw_clear_slave_status()
2031 if (test_bit(i, bus->assigned) == false) { in sdw_clear_slave_status()
2032 mutex_unlock(&bus->bus_lock); in sdw_clear_slave_status()
2035 mutex_unlock(&bus->bus_lock); in sdw_clear_slave_status()
2037 slave = sdw_get_slave(bus, i); in sdw_clear_slave_status()
2038 if (!slave) in sdw_clear_slave_status()
2041 if (slave->status != SDW_SLAVE_UNATTACHED) { in sdw_clear_slave_status()
2042 sdw_modify_slave_status(slave, SDW_SLAVE_UNATTACHED); in sdw_clear_slave_status()
2043 slave->first_interrupt_done = false; in sdw_clear_slave_status()
2044 sdw_update_slave_status(slave, SDW_SLAVE_UNATTACHED); in sdw_clear_slave_status()
2048 slave->unattach_request = request; in sdw_clear_slave_status()
2053 int sdw_bpt_send_async(struct sdw_bus *bus, struct sdw_slave *slave, struct sdw_bpt_msg *msg) in sdw_bpt_send_async() argument
2058 for (i = 0; i < msg->sections; i++) in sdw_bpt_send_async()
2059 len += msg->sec[i].len; in sdw_bpt_send_async()
2062 dev_err(bus->dev, "Invalid BPT message length %d\n", len); in sdw_bpt_send_async()
2063 return -EINVAL; in sdw_bpt_send_async()
2067 if (slave->dev_num == SDW_ENUM_DEV_NUM || in sdw_bpt_send_async()
2068 slave->dev_num > SDW_MAX_DEVICES) { in sdw_bpt_send_async()
2069 dev_err(&slave->dev, "Invalid device number %d\n", slave->dev_num); in sdw_bpt_send_async()
2070 return -ENODEV; in sdw_bpt_send_async()
2074 if (!bus->ops->bpt_send_async || in sdw_bpt_send_async()
2075 !bus->ops->bpt_wait) { in sdw_bpt_send_async()
2076 dev_err(bus->dev, "BPT callbacks not defined\n"); in sdw_bpt_send_async()
2077 return -EOPNOTSUPP; in sdw_bpt_send_async()
2080 return bus->ops->bpt_send_async(bus, slave, msg); in sdw_bpt_send_async()
2084 int sdw_bpt_wait(struct sdw_bus *bus, struct sdw_slave *slave, struct sdw_bpt_msg *msg) in sdw_bpt_wait() argument
2086 return bus->ops->bpt_wait(bus, slave, msg); in sdw_bpt_wait()
2090 int sdw_bpt_send_sync(struct sdw_bus *bus, struct sdw_slave *slave, struct sdw_bpt_msg *msg) in sdw_bpt_send_sync() argument
2094 ret = sdw_bpt_send_async(bus, slave, msg); in sdw_bpt_send_sync()
2098 return sdw_bpt_wait(bus, slave, msg); in sdw_bpt_send_sync()