Lines Matching +full:bus +full:- +full:addr
1 // SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause)
2 // Copyright(c) 2015-17 Intel Corporation.
11 #include "bus.h"
17 static int sdw_get_id(struct sdw_bus *bus) in sdw_get_id() argument
24 bus->id = rc; in sdw_get_id()
26 if (bus->controller_id == -1) in sdw_get_id()
27 bus->controller_id = rc; in sdw_get_id()
33 * sdw_bus_master_add() - add a bus Master instance
34 * @bus: bus instance
38 * Initializes the bus instance, read properties and create child
41 int sdw_bus_master_add(struct sdw_bus *bus, struct device *parent, in sdw_bus_master_add() argument
49 return -ENODEV; in sdw_bus_master_add()
52 ret = sdw_get_id(bus); in sdw_bus_master_add()
54 dev_err(parent, "Failed to get bus id\n"); in sdw_bus_master_add()
58 ret = sdw_master_device_add(bus, parent, fwnode); in sdw_bus_master_add()
61 bus->link_id); in sdw_bus_master_add()
65 if (!bus->ops) { in sdw_bus_master_add()
66 dev_err(bus->dev, "SoundWire Bus ops are not set\n"); in sdw_bus_master_add()
67 return -EINVAL; in sdw_bus_master_add()
70 if (!bus->compute_params) { in sdw_bus_master_add()
71 dev_err(bus->dev, in sdw_bus_master_add()
73 return -EINVAL; in sdw_bus_master_add()
79 * grabbed during configuration of a multi-bus stream. in sdw_bus_master_add()
81 lockdep_register_key(&bus->msg_lock_key); in sdw_bus_master_add()
82 __mutex_init(&bus->msg_lock, "msg_lock", &bus->msg_lock_key); in sdw_bus_master_add()
84 lockdep_register_key(&bus->bus_lock_key); in sdw_bus_master_add()
85 __mutex_init(&bus->bus_lock, "bus_lock", &bus->bus_lock_key); in sdw_bus_master_add()
87 INIT_LIST_HEAD(&bus->slaves); in sdw_bus_master_add()
88 INIT_LIST_HEAD(&bus->m_rt_list); in sdw_bus_master_add()
93 bus->multi_link = false; in sdw_bus_master_add()
94 if (bus->ops->read_prop) { in sdw_bus_master_add()
95 ret = bus->ops->read_prop(bus); in sdw_bus_master_add()
97 dev_err(bus->dev, in sdw_bus_master_add()
98 "Bus read properties failed:%d\n", ret); in sdw_bus_master_add()
103 sdw_bus_debugfs_init(bus); in sdw_bus_master_add()
113 *bus->assigned = ~GENMASK(SDW_BROADCAST_DEV_NUM, SDW_ENUM_DEV_NUM); in sdw_bus_master_add()
116 set_bit(SDW_ENUM_DEV_NUM, bus->assigned); in sdw_bus_master_add()
117 set_bit(SDW_BROADCAST_DEV_NUM, bus->assigned); in sdw_bus_master_add()
120 set_bit(SDW_GROUP12_DEV_NUM, bus->assigned); in sdw_bus_master_add()
121 set_bit(SDW_GROUP13_DEV_NUM, bus->assigned); in sdw_bus_master_add()
122 set_bit(SDW_MASTER_DEV_NUM, bus->assigned); in sdw_bus_master_add()
124 ret = sdw_irq_create(bus, fwnode); in sdw_bus_master_add()
129 * SDW is an enumerable bus, but devices can be powered off. So, in sdw_bus_master_add()
135 if (IS_ENABLED(CONFIG_ACPI) && ACPI_HANDLE(bus->dev)) in sdw_bus_master_add()
136 ret = sdw_acpi_find_slaves(bus); in sdw_bus_master_add()
137 else if (IS_ENABLED(CONFIG_OF) && bus->dev->of_node) in sdw_bus_master_add()
138 ret = sdw_of_find_slaves(bus); in sdw_bus_master_add()
140 ret = -ENOTSUPP; /* No ACPI/DT so error out */ in sdw_bus_master_add()
143 dev_err(bus->dev, "Finding slaves failed:%d\n", ret); in sdw_bus_master_add()
144 sdw_irq_delete(bus); in sdw_bus_master_add()
151 * is that the bus will start at highest clock frequency when in sdw_bus_master_add()
157 prop = &bus->prop; in sdw_bus_master_add()
158 bus->params.max_dr_freq = prop->max_clk_freq * SDW_DOUBLE_RATE_FACTOR; in sdw_bus_master_add()
159 bus->params.curr_dr_freq = bus->params.max_dr_freq; in sdw_bus_master_add()
160 bus->params.curr_bank = SDW_BANK0; in sdw_bus_master_add()
161 bus->params.next_bank = SDW_BANK1; in sdw_bus_master_add()
170 struct sdw_bus *bus = slave->bus; in sdw_delete_slave() local
176 mutex_lock(&bus->bus_lock); in sdw_delete_slave()
178 if (slave->dev_num) { /* clear dev_num if assigned */ in sdw_delete_slave()
179 clear_bit(slave->dev_num, bus->assigned); in sdw_delete_slave()
180 if (bus->ops && bus->ops->put_device_num) in sdw_delete_slave()
181 bus->ops->put_device_num(bus, slave); in sdw_delete_slave()
183 list_del_init(&slave->node); in sdw_delete_slave()
184 mutex_unlock(&bus->bus_lock); in sdw_delete_slave()
191 * sdw_bus_master_delete() - delete the bus master instance
192 * @bus: bus to be deleted
196 void sdw_bus_master_delete(struct sdw_bus *bus) in sdw_bus_master_delete() argument
198 device_for_each_child(bus->dev, NULL, sdw_delete_slave); in sdw_bus_master_delete()
200 sdw_irq_delete(bus); in sdw_bus_master_delete()
202 sdw_master_device_del(bus); in sdw_bus_master_delete()
204 sdw_bus_debugfs_exit(bus); in sdw_bus_master_delete()
205 lockdep_unregister_key(&bus->bus_lock_key); in sdw_bus_master_delete()
206 lockdep_unregister_key(&bus->msg_lock_key); in sdw_bus_master_delete()
207 ida_free(&sdw_bus_ida, bus->id); in sdw_bus_master_delete()
222 return -ENODATA; in find_response_code()
225 return -ETIMEDOUT; in find_response_code()
228 return -EIO; in find_response_code()
232 static inline int do_transfer(struct sdw_bus *bus, struct sdw_msg *msg) in do_transfer() argument
234 int retry = bus->prop.err_threshold; in do_transfer()
239 resp = bus->ops->xfer_msg(bus, msg); in do_transfer()
243 if (ret == 0 || ret == -ENODATA) in do_transfer()
250 static inline int do_transfer_defer(struct sdw_bus *bus, in do_transfer_defer() argument
253 struct sdw_defer *defer = &bus->defer_msg; in do_transfer_defer()
254 int retry = bus->prop.err_threshold; in do_transfer_defer()
258 defer->msg = msg; in do_transfer_defer()
259 defer->length = msg->len; in do_transfer_defer()
260 init_completion(&defer->complete); in do_transfer_defer()
263 resp = bus->ops->xfer_msg_defer(bus); in do_transfer_defer()
266 if (ret == 0 || ret == -ENODATA) in do_transfer_defer()
273 static int sdw_transfer_unlocked(struct sdw_bus *bus, struct sdw_msg *msg) in sdw_transfer_unlocked() argument
277 ret = do_transfer(bus, msg); in sdw_transfer_unlocked()
278 if (ret != 0 && ret != -ENODATA) in sdw_transfer_unlocked()
279 dev_err(bus->dev, "trf on Slave %d failed:%d %s addr %x count %d\n", in sdw_transfer_unlocked()
280 msg->dev_num, ret, in sdw_transfer_unlocked()
281 (msg->flags & SDW_MSG_FLAG_WRITE) ? "write" : "read", in sdw_transfer_unlocked()
282 msg->addr, msg->len); in sdw_transfer_unlocked()
288 * sdw_transfer() - Synchronous transfer message to a SDW Slave device
289 * @bus: SDW bus
292 int sdw_transfer(struct sdw_bus *bus, struct sdw_msg *msg) in sdw_transfer() argument
296 mutex_lock(&bus->msg_lock); in sdw_transfer()
298 ret = sdw_transfer_unlocked(bus, msg); in sdw_transfer()
300 mutex_unlock(&bus->msg_lock); in sdw_transfer()
306 * sdw_show_ping_status() - Direct report of PING status, to be used by Peripheral drivers
307 * @bus: SDW bus
310 void sdw_show_ping_status(struct sdw_bus *bus, bool sync_delay) in sdw_show_ping_status() argument
314 if (!bus->ops->read_ping_status) in sdw_show_ping_status()
318 * wait for peripheral to sync if desired. 10-15ms should be more than in sdw_show_ping_status()
324 mutex_lock(&bus->msg_lock); in sdw_show_ping_status()
326 status = bus->ops->read_ping_status(bus); in sdw_show_ping_status()
328 mutex_unlock(&bus->msg_lock); in sdw_show_ping_status()
331 dev_warn(bus->dev, "%s: no peripherals attached\n", __func__); in sdw_show_ping_status()
333 dev_dbg(bus->dev, "PING status: %#x\n", status); in sdw_show_ping_status()
338 * sdw_transfer_defer() - Asynchronously transfer message to a SDW Slave device
339 * @bus: SDW bus
344 int sdw_transfer_defer(struct sdw_bus *bus, struct sdw_msg *msg) in sdw_transfer_defer() argument
348 if (!bus->ops->xfer_msg_defer) in sdw_transfer_defer()
349 return -ENOTSUPP; in sdw_transfer_defer()
351 ret = do_transfer_defer(bus, msg); in sdw_transfer_defer()
352 if (ret != 0 && ret != -ENODATA) in sdw_transfer_defer()
353 dev_err(bus->dev, "Defer trf on Slave %d failed:%d\n", in sdw_transfer_defer()
354 msg->dev_num, ret); in sdw_transfer_defer()
360 u32 addr, size_t count, u16 dev_num, u8 flags, u8 *buf) in sdw_fill_msg() argument
363 msg->addr = addr; /* addr is 16 bit and truncated here */ in sdw_fill_msg()
364 msg->len = count; in sdw_fill_msg()
365 msg->dev_num = dev_num; in sdw_fill_msg()
366 msg->flags = flags; in sdw_fill_msg()
367 msg->buf = buf; in sdw_fill_msg()
369 if (addr < SDW_REG_NO_PAGE) /* no paging area */ in sdw_fill_msg()
372 if (addr >= SDW_REG_MAX) { /* illegal addr */ in sdw_fill_msg()
373 pr_err("SDW: Invalid address %x passed\n", addr); in sdw_fill_msg()
374 return -EINVAL; in sdw_fill_msg()
377 if (addr < SDW_REG_OPTIONAL_PAGE) { /* 32k but no page */ in sdw_fill_msg()
378 if (slave && !slave->prop.paging_support) in sdw_fill_msg()
380 /* no need for else as that will fall-through to paging */ in sdw_fill_msg()
386 return -EINVAL; in sdw_fill_msg()
390 pr_err("SDW: No slave for paging addr\n"); in sdw_fill_msg()
391 return -EINVAL; in sdw_fill_msg()
394 if (!slave->prop.paging_support) { in sdw_fill_msg()
395 dev_err(&slave->dev, in sdw_fill_msg()
396 "address %x needs paging but no support\n", addr); in sdw_fill_msg()
397 return -EINVAL; in sdw_fill_msg()
400 msg->addr_page1 = FIELD_GET(SDW_SCP_ADDRPAGE1_MASK, addr); in sdw_fill_msg()
401 msg->addr_page2 = FIELD_GET(SDW_SCP_ADDRPAGE2_MASK, addr); in sdw_fill_msg()
402 msg->addr |= BIT(15); in sdw_fill_msg()
403 msg->page = true; in sdw_fill_msg()
412 static int sdw_ntransfer_no_pm(struct sdw_slave *slave, u32 addr, u8 flags, in sdw_ntransfer_no_pm() argument
421 size = min_t(size_t, count, (SDW_REGADDR + 1) - (addr & SDW_REGADDR)); in sdw_ntransfer_no_pm()
423 ret = sdw_fill_msg(&msg, slave, addr, size, slave->dev_num, flags, val); in sdw_ntransfer_no_pm()
427 ret = sdw_transfer(slave->bus, &msg); in sdw_ntransfer_no_pm()
428 if (ret < 0 && !slave->is_mockup_device) in sdw_ntransfer_no_pm()
431 addr += size; in sdw_ntransfer_no_pm()
433 count -= size; in sdw_ntransfer_no_pm()
440 * sdw_nread_no_pm() - Read "n" contiguous SDW Slave registers with no PM
442 * @addr: Register address
449 int sdw_nread_no_pm(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nread_no_pm() argument
451 return sdw_ntransfer_no_pm(slave, addr, SDW_MSG_FLAG_READ, count, val); in sdw_nread_no_pm()
456 * sdw_nwrite_no_pm() - Write "n" contiguous SDW Slave registers with no PM
458 * @addr: Register address
465 int sdw_nwrite_no_pm(struct sdw_slave *slave, u32 addr, size_t count, const u8 *val) in sdw_nwrite_no_pm() argument
467 return sdw_ntransfer_no_pm(slave, addr, SDW_MSG_FLAG_WRITE, count, (u8 *)val); in sdw_nwrite_no_pm()
472 * sdw_write_no_pm() - Write a SDW Slave register with no PM
474 * @addr: Register address
477 int sdw_write_no_pm(struct sdw_slave *slave, u32 addr, u8 value) in sdw_write_no_pm() argument
479 return sdw_nwrite_no_pm(slave, addr, 1, &value); in sdw_write_no_pm()
484 sdw_bread_no_pm(struct sdw_bus *bus, u16 dev_num, u32 addr) in sdw_bread_no_pm() argument
490 ret = sdw_fill_msg(&msg, NULL, addr, 1, dev_num, in sdw_bread_no_pm()
495 ret = sdw_transfer(bus, &msg); in sdw_bread_no_pm()
503 sdw_bwrite_no_pm(struct sdw_bus *bus, u16 dev_num, u32 addr, u8 value) in sdw_bwrite_no_pm() argument
508 ret = sdw_fill_msg(&msg, NULL, addr, 1, dev_num, in sdw_bwrite_no_pm()
513 return sdw_transfer(bus, &msg); in sdw_bwrite_no_pm()
516 int sdw_bread_no_pm_unlocked(struct sdw_bus *bus, u16 dev_num, u32 addr) in sdw_bread_no_pm_unlocked() argument
522 ret = sdw_fill_msg(&msg, NULL, addr, 1, dev_num, in sdw_bread_no_pm_unlocked()
527 ret = sdw_transfer_unlocked(bus, &msg); in sdw_bread_no_pm_unlocked()
535 int sdw_bwrite_no_pm_unlocked(struct sdw_bus *bus, u16 dev_num, u32 addr, u8 value) in sdw_bwrite_no_pm_unlocked() argument
540 ret = sdw_fill_msg(&msg, NULL, addr, 1, dev_num, in sdw_bwrite_no_pm_unlocked()
545 return sdw_transfer_unlocked(bus, &msg); in sdw_bwrite_no_pm_unlocked()
550 * sdw_read_no_pm() - Read a SDW Slave register with no PM
552 * @addr: Register address
554 int sdw_read_no_pm(struct sdw_slave *slave, u32 addr) in sdw_read_no_pm() argument
559 ret = sdw_nread_no_pm(slave, addr, 1, &buf); in sdw_read_no_pm()
567 int sdw_update_no_pm(struct sdw_slave *slave, u32 addr, u8 mask, u8 val) in sdw_update_no_pm() argument
571 tmp = sdw_read_no_pm(slave, addr); in sdw_update_no_pm()
576 return sdw_write_no_pm(slave, addr, tmp); in sdw_update_no_pm()
580 /* Read-Modify-Write Slave register */
581 int sdw_update(struct sdw_slave *slave, u32 addr, u8 mask, u8 val) in sdw_update() argument
585 tmp = sdw_read(slave, addr); in sdw_update()
590 return sdw_write(slave, addr, tmp); in sdw_update()
595 * sdw_nread() - Read "n" contiguous SDW Slave registers
597 * @addr: Register address
606 int sdw_nread(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nread() argument
610 ret = pm_runtime_get_sync(&slave->dev); in sdw_nread()
611 if (ret < 0 && ret != -EACCES) { in sdw_nread()
612 pm_runtime_put_noidle(&slave->dev); in sdw_nread()
616 ret = sdw_nread_no_pm(slave, addr, count, val); in sdw_nread()
618 pm_runtime_mark_last_busy(&slave->dev); in sdw_nread()
619 pm_runtime_put(&slave->dev); in sdw_nread()
626 * sdw_nwrite() - Write "n" contiguous SDW Slave registers
628 * @addr: Register address
637 int sdw_nwrite(struct sdw_slave *slave, u32 addr, size_t count, const u8 *val) in sdw_nwrite() argument
641 ret = pm_runtime_get_sync(&slave->dev); in sdw_nwrite()
642 if (ret < 0 && ret != -EACCES) { in sdw_nwrite()
643 pm_runtime_put_noidle(&slave->dev); in sdw_nwrite()
647 ret = sdw_nwrite_no_pm(slave, addr, count, val); in sdw_nwrite()
649 pm_runtime_mark_last_busy(&slave->dev); in sdw_nwrite()
650 pm_runtime_put(&slave->dev); in sdw_nwrite()
657 * sdw_read() - Read a SDW Slave register
659 * @addr: Register address
664 int sdw_read(struct sdw_slave *slave, u32 addr) in sdw_read() argument
669 ret = sdw_nread(slave, addr, 1, &buf); in sdw_read()
678 * sdw_write() - Write a SDW Slave register
680 * @addr: Register address
686 int sdw_write(struct sdw_slave *slave, u32 addr, u8 value) in sdw_write() argument
688 return sdw_nwrite(slave, addr, 1, &value); in sdw_write()
697 static struct sdw_slave *sdw_get_slave(struct sdw_bus *bus, int i) in sdw_get_slave() argument
701 list_for_each_entry(slave, &bus->slaves, node) { in sdw_get_slave()
702 if (slave->dev_num == i) in sdw_get_slave()
711 if (slave->id.mfg_id != id.mfg_id || in sdw_compare_devid()
712 slave->id.part_id != id.part_id || in sdw_compare_devid()
713 slave->id.class_id != id.class_id || in sdw_compare_devid()
714 (slave->id.unique_id != SDW_IGNORED_UNIQUE_ID && in sdw_compare_devid()
715 slave->id.unique_id != id.unique_id)) in sdw_compare_devid()
716 return -ENODEV; in sdw_compare_devid()
725 struct sdw_bus *bus = slave->bus; in sdw_get_device_num() local
728 if (bus->ops && bus->ops->get_device_num) { in sdw_get_device_num()
729 bit = bus->ops->get_device_num(bus, slave); in sdw_get_device_num()
733 bit = find_first_zero_bit(bus->assigned, SDW_MAX_DEVICES); in sdw_get_device_num()
735 bit = -ENODEV; in sdw_get_device_num()
744 set_bit(bit, bus->assigned); in sdw_get_device_num()
752 struct sdw_bus *bus = slave->bus; in sdw_assign_device_num() local
757 if (!slave->dev_num) { in sdw_assign_device_num()
758 if (!slave->dev_num_sticky) { in sdw_assign_device_num()
759 mutex_lock(&slave->bus->bus_lock); in sdw_assign_device_num()
761 mutex_unlock(&slave->bus->bus_lock); in sdw_assign_device_num()
763 dev_err(bus->dev, "Get dev_num failed: %d\n", in sdw_assign_device_num()
767 slave->dev_num = dev_num; in sdw_assign_device_num()
768 slave->dev_num_sticky = dev_num; in sdw_assign_device_num()
771 slave->dev_num = slave->dev_num_sticky; in sdw_assign_device_num()
776 dev_dbg(bus->dev, in sdw_assign_device_num()
778 slave->dev_num); in sdw_assign_device_num()
780 /* Clear the slave->dev_num to transfer message on device 0 */ in sdw_assign_device_num()
781 dev_num = slave->dev_num; in sdw_assign_device_num()
782 slave->dev_num = 0; in sdw_assign_device_num()
786 dev_err(bus->dev, "Program device_num %d failed: %d\n", in sdw_assign_device_num()
792 slave->dev_num = slave->dev_num_sticky; in sdw_assign_device_num()
794 if (bus->ops && bus->ops->new_peripheral_assigned) in sdw_assign_device_num()
795 bus->ops->new_peripheral_assigned(bus, slave, dev_num); in sdw_assign_device_num()
800 void sdw_extract_slave_id(struct sdw_bus *bus, in sdw_extract_slave_id() argument
801 u64 addr, struct sdw_slave_id *id) in sdw_extract_slave_id() argument
803 dev_dbg(bus->dev, "SDW Slave Addr: %llx\n", addr); in sdw_extract_slave_id()
805 id->sdw_version = SDW_VERSION(addr); in sdw_extract_slave_id()
806 id->unique_id = SDW_UNIQUE_ID(addr); in sdw_extract_slave_id()
807 id->mfg_id = SDW_MFG_ID(addr); in sdw_extract_slave_id()
808 id->part_id = SDW_PART_ID(addr); in sdw_extract_slave_id()
809 id->class_id = SDW_CLASS_ID(addr); in sdw_extract_slave_id()
811 dev_dbg(bus->dev, in sdw_extract_slave_id()
813 id->class_id, id->mfg_id, id->part_id, id->unique_id, id->sdw_version); in sdw_extract_slave_id()
817 static int sdw_program_device_num(struct sdw_bus *bus, bool *programmed) in sdw_program_device_num() argument
825 u64 addr; in sdw_program_device_num() local
836 ret = sdw_transfer(bus, &msg); in sdw_program_device_num()
837 if (ret == -ENODATA) { /* end of device id reads */ in sdw_program_device_num()
838 dev_dbg(bus->dev, "No more devices to enumerate\n"); in sdw_program_device_num()
843 dev_err(bus->dev, "DEVID read fail:%d\n", ret); in sdw_program_device_num()
848 * Construct the addr and extract. Cast the higher shift in sdw_program_device_num()
851 addr = buf[5] | (buf[4] << 8) | (buf[3] << 16) | in sdw_program_device_num()
855 sdw_extract_slave_id(bus, addr, &id); in sdw_program_device_num()
859 list_for_each_entry_safe(slave, _s, &bus->slaves, node) { in sdw_program_device_num()
864 * To prevent skipping state-machine stages don't in sdw_program_device_num()
870 if (slave->status != SDW_SLAVE_UNATTACHED) in sdw_program_device_num()
881 dev_err(bus->dev, in sdw_program_device_num()
902 sdw_slave_add(bus, &id, NULL); in sdw_program_device_num()
904 dev_err(bus->dev, "Slave Entry not found\n"); in sdw_program_device_num()
923 struct sdw_bus *bus = slave->bus; in sdw_modify_slave_status() local
925 mutex_lock(&bus->bus_lock); in sdw_modify_slave_status()
927 dev_vdbg(bus->dev, in sdw_modify_slave_status()
929 slave->dev_num, slave->status, status); in sdw_modify_slave_status()
932 dev_dbg(&slave->dev, in sdw_modify_slave_status()
934 slave->dev_num); in sdw_modify_slave_status()
936 reinit_completion(&slave->enumeration_complete); in sdw_modify_slave_status()
937 reinit_completion(&slave->initialization_complete); in sdw_modify_slave_status()
940 (slave->status == SDW_SLAVE_UNATTACHED)) { in sdw_modify_slave_status()
941 dev_dbg(&slave->dev, in sdw_modify_slave_status()
943 slave->dev_num); in sdw_modify_slave_status()
945 complete_all(&slave->enumeration_complete); in sdw_modify_slave_status()
947 slave->status = status; in sdw_modify_slave_status()
948 mutex_unlock(&bus->bus_lock); in sdw_modify_slave_status()
957 mutex_lock(&slave->sdw_dev_lock); in sdw_slave_clk_stop_callback()
959 if (slave->probed) { in sdw_slave_clk_stop_callback()
960 struct device *dev = &slave->dev; in sdw_slave_clk_stop_callback()
961 struct sdw_driver *drv = drv_to_sdw_driver(dev->driver); in sdw_slave_clk_stop_callback()
963 if (drv->ops && drv->ops->clk_stop) in sdw_slave_clk_stop_callback()
964 ret = drv->ops->clk_stop(slave, mode, type); in sdw_slave_clk_stop_callback()
967 mutex_unlock(&slave->sdw_dev_lock); in sdw_slave_clk_stop_callback()
980 wake_en = slave->prop.wake_capable; in sdw_slave_clk_stop_prepare()
993 if (ret != -ENODATA) in sdw_slave_clk_stop_prepare()
994 dev_err(&slave->dev, "SDW_SCP_SYSTEMCTRL read failed:%d\n", ret); in sdw_slave_clk_stop_prepare()
1003 if (ret < 0 && ret != -ENODATA) in sdw_slave_clk_stop_prepare()
1004 dev_err(&slave->dev, "SDW_SCP_SYSTEMCTRL write failed:%d\n", ret); in sdw_slave_clk_stop_prepare()
1009 static int sdw_bus_wait_for_clk_prep_deprep(struct sdw_bus *bus, u16 dev_num) in sdw_bus_wait_for_clk_prep_deprep() argument
1011 int retry = bus->clk_stop_timeout; in sdw_bus_wait_for_clk_prep_deprep()
1015 val = sdw_bread_no_pm(bus, dev_num, SDW_SCP_STAT); in sdw_bus_wait_for_clk_prep_deprep()
1017 if (val != -ENODATA) in sdw_bus_wait_for_clk_prep_deprep()
1018 dev_err(bus->dev, "SDW_SCP_STAT bread failed:%d\n", val); in sdw_bus_wait_for_clk_prep_deprep()
1023 dev_dbg(bus->dev, "clock stop prep/de-prep done slave:%d\n", in sdw_bus_wait_for_clk_prep_deprep()
1029 retry--; in sdw_bus_wait_for_clk_prep_deprep()
1032 dev_err(bus->dev, "clock stop prep/de-prep failed slave:%d\n", in sdw_bus_wait_for_clk_prep_deprep()
1035 return -ETIMEDOUT; in sdw_bus_wait_for_clk_prep_deprep()
1041 * @bus: SDW bus instance
1045 int sdw_bus_prep_clk_stop(struct sdw_bus *bus) in sdw_bus_prep_clk_stop() argument
1057 * replies with Command Ignored/-ENODATA, we continue in sdw_bus_prep_clk_stop()
1060 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_prep_clk_stop()
1061 if (!slave->dev_num) in sdw_bus_prep_clk_stop()
1064 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_prep_clk_stop()
1065 slave->status != SDW_SLAVE_ALERT) in sdw_bus_prep_clk_stop()
1068 /* Identify if Slave(s) are available on Bus */ in sdw_bus_prep_clk_stop()
1074 if (ret < 0 && ret != -ENODATA) { in sdw_bus_prep_clk_stop()
1075 dev_err(&slave->dev, "clock stop pre-prepare cb failed:%d\n", ret); in sdw_bus_prep_clk_stop()
1080 if (!slave->prop.simple_clk_stop_capable) { in sdw_bus_prep_clk_stop()
1086 if (ret < 0 && ret != -ENODATA) { in sdw_bus_prep_clk_stop()
1087 dev_err(&slave->dev, "clock stop prepare failed:%d\n", ret); in sdw_bus_prep_clk_stop()
1102 ret = sdw_bus_wait_for_clk_prep_deprep(bus, in sdw_bus_prep_clk_stop()
1106 * Command_Ignored/-ENODATA, we don't need to continue with the in sdw_bus_prep_clk_stop()
1115 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_prep_clk_stop()
1116 if (!slave->dev_num) in sdw_bus_prep_clk_stop()
1119 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_prep_clk_stop()
1120 slave->status != SDW_SLAVE_ALERT) in sdw_bus_prep_clk_stop()
1127 if (ret < 0 && ret != -ENODATA) { in sdw_bus_prep_clk_stop()
1128 dev_err(&slave->dev, "clock stop post-prepare cb failed:%d\n", ret); in sdw_bus_prep_clk_stop()
1138 * sdw_bus_clk_stop: stop bus clock
1140 * @bus: SDW bus instance
1145 int sdw_bus_clk_stop(struct sdw_bus *bus) in sdw_bus_clk_stop() argument
1153 ret = sdw_bwrite_no_pm(bus, SDW_BROADCAST_DEV_NUM, in sdw_bus_clk_stop()
1156 if (ret != -ENODATA) in sdw_bus_clk_stop()
1157 dev_err(bus->dev, "ClockStopNow Broadcast msg failed %d\n", ret); in sdw_bus_clk_stop()
1168 * @bus: SDW bus instance
1170 * This De-prepares the Slaves by exiting Clock Stop Mode 0. For the Slaves
1171 * exiting Clock Stop Mode 1, they will be de-prepared after they enumerate
1174 int sdw_bus_exit_clk_stop(struct sdw_bus *bus) in sdw_bus_exit_clk_stop() argument
1182 * In order to save on transition time, de-prepare in sdw_bus_exit_clk_stop()
1184 * de-prepared after clock resume. in sdw_bus_exit_clk_stop()
1186 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_exit_clk_stop()
1187 if (!slave->dev_num) in sdw_bus_exit_clk_stop()
1190 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_exit_clk_stop()
1191 slave->status != SDW_SLAVE_ALERT) in sdw_bus_exit_clk_stop()
1194 /* Identify if Slave(s) are available on Bus */ in sdw_bus_exit_clk_stop()
1200 dev_warn(&slave->dev, "clock stop pre-deprepare cb failed:%d\n", ret); in sdw_bus_exit_clk_stop()
1202 /* Only de-prepare a Slave device if needed */ in sdw_bus_exit_clk_stop()
1203 if (!slave->prop.simple_clk_stop_capable) { in sdw_bus_exit_clk_stop()
1210 dev_warn(&slave->dev, "clock stop deprepare failed:%d\n", ret); in sdw_bus_exit_clk_stop()
1214 /* Skip remaining clock stop de-preparation if no Slave is attached */ in sdw_bus_exit_clk_stop()
1223 ret = sdw_bus_wait_for_clk_prep_deprep(bus, SDW_BROADCAST_DEV_NUM); in sdw_bus_exit_clk_stop()
1225 dev_warn(bus->dev, "clock stop deprepare wait failed:%d\n", ret); in sdw_bus_exit_clk_stop()
1228 list_for_each_entry(slave, &bus->slaves, node) { in sdw_bus_exit_clk_stop()
1229 if (!slave->dev_num) in sdw_bus_exit_clk_stop()
1232 if (slave->status != SDW_SLAVE_ATTACHED && in sdw_bus_exit_clk_stop()
1233 slave->status != SDW_SLAVE_ALERT) in sdw_bus_exit_clk_stop()
1239 dev_warn(&slave->dev, "clock stop post-deprepare cb failed:%d\n", ret); in sdw_bus_exit_clk_stop()
1249 u32 addr; in sdw_configure_dpn_intr() local
1253 if (slave->bus->params.s_data_mode != SDW_PORT_DATA_MODE_NORMAL) { in sdw_configure_dpn_intr()
1254 dev_dbg(&slave->dev, "TEST FAIL interrupt %s\n", in sdw_configure_dpn_intr()
1259 addr = SDW_DPN_INTMASK(port); in sdw_configure_dpn_intr()
1270 ret = sdw_update_no_pm(slave, addr, (mask | SDW_DPN_INT_PORT_READY), val); in sdw_configure_dpn_intr()
1272 dev_err(&slave->dev, in sdw_configure_dpn_intr()
1280 u32 mclk_freq = slave->bus->prop.mclk_freq; in sdw_slave_set_frequency()
1281 u32 curr_freq = slave->bus->params.curr_dr_freq >> 1; in sdw_slave_set_frequency()
1289 * devices. They may also be used for 1.2+/non-SDCA devices. in sdw_slave_set_frequency()
1293 if (!slave->id.class_id && !slave->prop.clock_reg_supported) in sdw_slave_set_frequency()
1297 dev_err(&slave->dev, in sdw_slave_set_frequency()
1298 "no bus MCLK, cannot set SDW_SCP_BUS_CLOCK_BASE\n"); in sdw_slave_set_frequency()
1299 return -EINVAL; in sdw_slave_set_frequency()
1327 dev_err(&slave->dev, in sdw_slave_set_frequency()
1330 return -EINVAL; in sdw_slave_set_frequency()
1334 dev_err(&slave->dev, in sdw_slave_set_frequency()
1335 "mclk %d is not multiple of bus curr_freq %d\n", in sdw_slave_set_frequency()
1337 return -EINVAL; in sdw_slave_set_frequency()
1343 * map scale to Table 90 of SoundWire 1.2 spec - and check in sdw_slave_set_frequency()
1349 dev_err(&slave->dev, in sdw_slave_set_frequency()
1350 "No match found for scale %d, bus mclk %d curr_freq %d\n", in sdw_slave_set_frequency()
1352 return -EINVAL; in sdw_slave_set_frequency()
1358 dev_err(&slave->dev, in sdw_slave_set_frequency()
1366 dev_err(&slave->dev, in sdw_slave_set_frequency()
1372 dev_err(&slave->dev, in sdw_slave_set_frequency()
1375 dev_dbg(&slave->dev, in sdw_slave_set_frequency()
1376 "Configured bus base %d, scale %d, mclk %d, curr_freq %d\n", in sdw_slave_set_frequency()
1384 struct sdw_slave_prop *prop = &slave->prop; in sdw_initialize_slave()
1393 if (slave->bus->prop.quirks & SDW_MASTER_QUIRKS_CLEAR_INITIAL_CLASH) { in sdw_initialize_slave()
1394 /* Clear bus clash interrupt before enabling interrupt mask */ in sdw_initialize_slave()
1397 dev_err(&slave->dev, in sdw_initialize_slave()
1402 dev_warn(&slave->dev, "Bus clash detected before INT mask is enabled\n"); in sdw_initialize_slave()
1405 dev_err(&slave->dev, in sdw_initialize_slave()
1411 if ((slave->bus->prop.quirks & SDW_MASTER_QUIRKS_CLEAR_INITIAL_PARITY) && in sdw_initialize_slave()
1412 !(slave->prop.quirks & SDW_SLAVE_QUIRKS_INVALID_INITIAL_PARITY)) { in sdw_initialize_slave()
1416 dev_err(&slave->dev, in sdw_initialize_slave()
1421 dev_warn(&slave->dev, "PARITY error detected before INT mask is enabled\n"); in sdw_initialize_slave()
1424 dev_err(&slave->dev, in sdw_initialize_slave()
1432 * Set SCP_INT1_MASK register, typically bus clash and in sdw_initialize_slave()
1433 * implementation-defined interrupt mask. The Parity detection in sdw_initialize_slave()
1435 * device-dependent, it might e.g. only be enabled in in sdw_initialize_slave()
1436 * steady-state after a couple of frames. in sdw_initialize_slave()
1438 val = slave->prop.scp_int1_mask; in sdw_initialize_slave()
1443 dev_err(&slave->dev, in sdw_initialize_slave()
1449 if (!slave->prop.dp0_prop) in sdw_initialize_slave()
1453 val = prop->dp0_prop->imp_def_interrupts; in sdw_initialize_slave()
1458 dev_err(&slave->dev, in sdw_initialize_slave()
1470 dev_err(&slave->dev, in sdw_handle_dp0_interrupt()
1479 dev_err(&slave->dev, "Test fail for port 0\n"); in sdw_handle_dp0_interrupt()
1489 complete(&slave->port_ready[0]); in sdw_handle_dp0_interrupt()
1494 dev_err(&slave->dev, "BRA failed\n"); in sdw_handle_dp0_interrupt()
1509 dev_err(&slave->dev, in sdw_handle_dp0_interrupt()
1517 dev_err(&slave->dev, in sdw_handle_dp0_interrupt()
1530 dev_warn(&slave->dev, "Reached MAX_RETRY on DP0 read\n"); in sdw_handle_dp0_interrupt()
1540 u32 addr; in sdw_handle_port_interrupt() local
1545 addr = SDW_DPN_INT(port); in sdw_handle_port_interrupt()
1546 status = sdw_read_no_pm(slave, addr); in sdw_handle_port_interrupt()
1548 dev_err(&slave->dev, in sdw_handle_port_interrupt()
1558 dev_err(&slave->dev, "Test fail for port:%d\n", port); in sdw_handle_port_interrupt()
1567 complete(&slave->port_ready[port]); in sdw_handle_port_interrupt()
1580 ret = sdw_write_no_pm(slave, addr, clear); in sdw_handle_port_interrupt()
1582 dev_err(&slave->dev, in sdw_handle_port_interrupt()
1588 status2 = sdw_read_no_pm(slave, addr); in sdw_handle_port_interrupt()
1590 dev_err(&slave->dev, in sdw_handle_port_interrupt()
1603 dev_warn(&slave->dev, "Reached MAX_RETRY on port read"); in sdw_handle_port_interrupt()
1622 ret = pm_runtime_get_sync(&slave->dev); in sdw_handle_slave_alerts()
1623 if (ret < 0 && ret != -EACCES) { in sdw_handle_slave_alerts()
1624 dev_err(&slave->dev, "Failed to resume device: %d\n", ret); in sdw_handle_slave_alerts()
1625 pm_runtime_put_noidle(&slave->dev); in sdw_handle_slave_alerts()
1632 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1640 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1645 if (slave->id.class_id) { in sdw_handle_slave_alerts()
1648 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1659 * Check parity, bus clash and Slave (impl defined) in sdw_handle_slave_alerts()
1663 parity_check = slave->prop.scp_int1_mask & SDW_SCP_INT1_PARITY; in sdw_handle_slave_alerts()
1664 parity_quirk = !slave->first_interrupt_done && in sdw_handle_slave_alerts()
1665 (slave->prop.quirks & SDW_SLAVE_QUIRKS_INVALID_INITIAL_PARITY); in sdw_handle_slave_alerts()
1668 dev_err(&slave->dev, "Parity error detected\n"); in sdw_handle_slave_alerts()
1673 if (slave->prop.scp_int1_mask & SDW_SCP_INT1_BUS_CLASH) in sdw_handle_slave_alerts()
1674 dev_err(&slave->dev, "Bus clash detected\n"); in sdw_handle_slave_alerts()
1679 * When bus clash or parity errors are detected, such errors in sdw_handle_slave_alerts()
1681 * TODO: In such scenario, reset bus. Make this configurable in sdw_handle_slave_alerts()
1682 * via sysfs property with bus reset being the default. in sdw_handle_slave_alerts()
1686 if (slave->prop.scp_int1_mask & SDW_SCP_INT1_IMPL_DEF) { in sdw_handle_slave_alerts()
1687 dev_dbg(&slave->dev, "Slave impl defined interrupt\n"); in sdw_handle_slave_alerts()
1697 /* Check port 0 - 3 interrupts */ in sdw_handle_slave_alerts()
1733 mutex_lock(&slave->sdw_dev_lock); in sdw_handle_slave_alerts()
1735 if (slave->probed) { in sdw_handle_slave_alerts()
1736 struct device *dev = &slave->dev; in sdw_handle_slave_alerts()
1737 struct sdw_driver *drv = drv_to_sdw_driver(dev->driver); in sdw_handle_slave_alerts()
1739 if (slave->prop.use_domain_irq && slave->irq) in sdw_handle_slave_alerts()
1740 handle_nested_irq(slave->irq); in sdw_handle_slave_alerts()
1742 if (drv->ops && drv->ops->interrupt_callback) { in sdw_handle_slave_alerts()
1748 drv->ops->interrupt_callback(slave, &slave_intr); in sdw_handle_slave_alerts()
1752 mutex_unlock(&slave->sdw_dev_lock); in sdw_handle_slave_alerts()
1758 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1764 slave->first_interrupt_done = true; in sdw_handle_slave_alerts()
1772 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1780 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1785 if (slave->id.class_id) { in sdw_handle_slave_alerts()
1788 dev_err(&slave->dev, in sdw_handle_slave_alerts()
1810 dev_warn(&slave->dev, "Reached MAX_RETRY on alert read\n"); in sdw_handle_slave_alerts()
1813 pm_runtime_mark_last_busy(&slave->dev); in sdw_handle_slave_alerts()
1814 pm_runtime_put_autosuspend(&slave->dev); in sdw_handle_slave_alerts()
1824 mutex_lock(&slave->sdw_dev_lock); in sdw_update_slave_status()
1826 if (slave->probed) { in sdw_update_slave_status()
1827 struct device *dev = &slave->dev; in sdw_update_slave_status()
1828 struct sdw_driver *drv = drv_to_sdw_driver(dev->driver); in sdw_update_slave_status()
1830 if (drv->ops && drv->ops->update_status) in sdw_update_slave_status()
1831 ret = drv->ops->update_status(slave, status); in sdw_update_slave_status()
1834 mutex_unlock(&slave->sdw_dev_lock); in sdw_update_slave_status()
1840 * sdw_handle_slave_status() - Handle Slave status
1841 * @bus: SDW bus instance
1844 int sdw_handle_slave_status(struct sdw_bus *bus, in sdw_handle_slave_status() argument
1852 /* first check if any Slaves fell off the bus */ in sdw_handle_slave_status()
1854 mutex_lock(&bus->bus_lock); in sdw_handle_slave_status()
1855 if (test_bit(i, bus->assigned) == false) { in sdw_handle_slave_status()
1856 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
1859 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
1861 slave = sdw_get_slave(bus, i); in sdw_handle_slave_status()
1866 slave->status != SDW_SLAVE_UNATTACHED) { in sdw_handle_slave_status()
1867 dev_warn(&slave->dev, "Slave %d state check1: UNATTACHED, status was %d\n", in sdw_handle_slave_status()
1868 i, slave->status); in sdw_handle_slave_status()
1874 dev_warn(&slave->dev, "Update Slave status failed:%d\n", ret); in sdw_handle_slave_status()
1879 dev_dbg(bus->dev, "Slave attached, programming device number\n"); in sdw_handle_slave_status()
1894 sdw_program_device_num(bus, &id_programmed); in sdw_handle_slave_status()
1901 mutex_lock(&bus->bus_lock); in sdw_handle_slave_status()
1902 if (test_bit(i, bus->assigned) == false) { in sdw_handle_slave_status()
1903 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
1906 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
1908 slave = sdw_get_slave(bus, i); in sdw_handle_slave_status()
1916 if (slave->status == SDW_SLAVE_UNATTACHED) in sdw_handle_slave_status()
1919 dev_warn(&slave->dev, "Slave %d state check2: UNATTACHED, status was %d\n", in sdw_handle_slave_status()
1920 i, slave->status); in sdw_handle_slave_status()
1928 dev_err(&slave->dev, in sdw_handle_slave_status()
1934 if (slave->status == SDW_SLAVE_ATTACHED) in sdw_handle_slave_status()
1937 prev_status = slave->status; in sdw_handle_slave_status()
1947 dev_err(&slave->dev, in sdw_handle_slave_status()
1954 dev_err(&slave->dev, "Invalid slave %d status:%d\n", in sdw_handle_slave_status()
1961 dev_err(&slave->dev, in sdw_handle_slave_status()
1964 dev_dbg(&slave->dev, in sdw_handle_slave_status()
1966 slave->dev_num); in sdw_handle_slave_status()
1968 complete_all(&slave->initialization_complete); in sdw_handle_slave_status()
1977 * This would be a no-op in case the peripheral was being resumed in sdw_handle_slave_status()
1980 pm_request_resume(&slave->dev); in sdw_handle_slave_status()
1988 void sdw_clear_slave_status(struct sdw_bus *bus, u32 request) in sdw_clear_slave_status() argument
1993 /* Check all non-zero devices */ in sdw_clear_slave_status()
1995 mutex_lock(&bus->bus_lock); in sdw_clear_slave_status()
1996 if (test_bit(i, bus->assigned) == false) { in sdw_clear_slave_status()
1997 mutex_unlock(&bus->bus_lock); in sdw_clear_slave_status()
2000 mutex_unlock(&bus->bus_lock); in sdw_clear_slave_status()
2002 slave = sdw_get_slave(bus, i); in sdw_clear_slave_status()
2006 if (slave->status != SDW_SLAVE_UNATTACHED) { in sdw_clear_slave_status()
2008 slave->first_interrupt_done = false; in sdw_clear_slave_status()
2013 slave->unattach_request = request; in sdw_clear_slave_status()