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.
9 #include "bus.h"
12 * sdw_add_bus_master() - add a bus Master instance
13 * @bus: bus instance
15 * Initializes the bus instance, read properties and create child
18 int sdw_add_bus_master(struct sdw_bus *bus) in sdw_add_bus_master() argument
23 if (!bus->dev) { in sdw_add_bus_master()
24 pr_err("SoundWire bus has no device"); in sdw_add_bus_master()
25 return -ENODEV; in sdw_add_bus_master()
28 if (!bus->ops) { in sdw_add_bus_master()
29 dev_err(bus->dev, "SoundWire Bus ops are not set"); in sdw_add_bus_master()
30 return -EINVAL; in sdw_add_bus_master()
33 mutex_init(&bus->msg_lock); in sdw_add_bus_master()
34 mutex_init(&bus->bus_lock); in sdw_add_bus_master()
35 INIT_LIST_HEAD(&bus->slaves); in sdw_add_bus_master()
36 INIT_LIST_HEAD(&bus->m_rt_list); in sdw_add_bus_master()
38 if (bus->ops->read_prop) { in sdw_add_bus_master()
39 ret = bus->ops->read_prop(bus); in sdw_add_bus_master()
41 dev_err(bus->dev, "Bus read properties failed:%d", ret); in sdw_add_bus_master()
54 *bus->assigned = ~GENMASK(SDW_BROADCAST_DEV_NUM, SDW_ENUM_DEV_NUM); in sdw_add_bus_master()
57 set_bit(SDW_ENUM_DEV_NUM, bus->assigned); in sdw_add_bus_master()
58 set_bit(SDW_BROADCAST_DEV_NUM, bus->assigned); in sdw_add_bus_master()
61 set_bit(SDW_GROUP12_DEV_NUM, bus->assigned); in sdw_add_bus_master()
62 set_bit(SDW_GROUP13_DEV_NUM, bus->assigned); in sdw_add_bus_master()
63 set_bit(SDW_MASTER_DEV_NUM, bus->assigned); in sdw_add_bus_master()
66 * SDW is an enumerable bus, but devices can be powered off. So, in sdw_add_bus_master()
72 if (IS_ENABLED(CONFIG_ACPI) && ACPI_HANDLE(bus->dev)) in sdw_add_bus_master()
73 ret = sdw_acpi_find_slaves(bus); in sdw_add_bus_master()
75 ret = -ENOTSUPP; /* No ACPI/DT so error out */ in sdw_add_bus_master()
78 dev_err(bus->dev, "Finding slaves failed:%d\n", ret); in sdw_add_bus_master()
85 * is that the bus will start at highest clock frequency when in sdw_add_bus_master()
91 prop = &bus->prop; in sdw_add_bus_master()
92 bus->params.max_dr_freq = prop->max_freq * SDW_DOUBLE_RATE_FACTOR; in sdw_add_bus_master()
93 bus->params.curr_dr_freq = bus->params.max_dr_freq; in sdw_add_bus_master()
94 bus->params.curr_bank = SDW_BANK0; in sdw_add_bus_master()
95 bus->params.next_bank = SDW_BANK1; in sdw_add_bus_master()
104 struct sdw_bus *bus = slave->bus; in sdw_delete_slave() local
106 mutex_lock(&bus->bus_lock); in sdw_delete_slave()
108 if (slave->dev_num) /* clear dev_num if assigned */ in sdw_delete_slave()
109 clear_bit(slave->dev_num, bus->assigned); in sdw_delete_slave()
111 list_del_init(&slave->node); in sdw_delete_slave()
112 mutex_unlock(&bus->bus_lock); in sdw_delete_slave()
119 * sdw_delete_bus_master() - delete the bus master instance
120 * @bus: bus to be deleted
124 void sdw_delete_bus_master(struct sdw_bus *bus) in sdw_delete_bus_master() argument
126 device_for_each_child(bus->dev, NULL, sdw_delete_slave); in sdw_delete_bus_master()
141 return -ENODATA; in find_response_code()
144 return -ETIMEDOUT; in find_response_code()
147 return -EIO; in find_response_code()
151 static inline int do_transfer(struct sdw_bus *bus, struct sdw_msg *msg) in do_transfer() argument
153 int retry = bus->prop.err_threshold; in do_transfer()
158 resp = bus->ops->xfer_msg(bus, msg); in do_transfer()
162 if (ret == 0 || ret == -ENODATA) in do_transfer()
169 static inline int do_transfer_defer(struct sdw_bus *bus, in do_transfer_defer() argument
172 int retry = bus->prop.err_threshold; in do_transfer_defer()
176 defer->msg = msg; in do_transfer_defer()
177 defer->length = msg->len; in do_transfer_defer()
178 init_completion(&defer->complete); in do_transfer_defer()
181 resp = bus->ops->xfer_msg_defer(bus, msg, defer); in do_transfer_defer()
184 if (ret == 0 || ret == -ENODATA) in do_transfer_defer()
191 static int sdw_reset_page(struct sdw_bus *bus, u16 dev_num) in sdw_reset_page() argument
193 int retry = bus->prop.err_threshold; in sdw_reset_page()
198 resp = bus->ops->reset_page_addr(bus, dev_num); in sdw_reset_page()
201 if (ret == 0 || ret == -ENODATA) in sdw_reset_page()
209 * sdw_transfer() - Synchronous transfer message to a SDW Slave device
210 * @bus: SDW bus
213 int sdw_transfer(struct sdw_bus *bus, struct sdw_msg *msg) in sdw_transfer() argument
217 mutex_lock(&bus->msg_lock); in sdw_transfer()
219 ret = do_transfer(bus, msg); in sdw_transfer()
220 if (ret != 0 && ret != -ENODATA) in sdw_transfer()
221 dev_err(bus->dev, "trf on Slave %d failed:%d\n", in sdw_transfer()
222 msg->dev_num, ret); in sdw_transfer()
224 if (msg->page) in sdw_transfer()
225 sdw_reset_page(bus, msg->dev_num); in sdw_transfer()
227 mutex_unlock(&bus->msg_lock); in sdw_transfer()
233 * sdw_transfer_defer() - Asynchronously transfer message to a SDW Slave device
234 * @bus: SDW bus
240 int sdw_transfer_defer(struct sdw_bus *bus, struct sdw_msg *msg, in sdw_transfer_defer() argument
245 if (!bus->ops->xfer_msg_defer) in sdw_transfer_defer()
246 return -ENOTSUPP; in sdw_transfer_defer()
248 ret = do_transfer_defer(bus, msg, defer); in sdw_transfer_defer()
249 if (ret != 0 && ret != -ENODATA) in sdw_transfer_defer()
250 dev_err(bus->dev, "Defer trf on Slave %d failed:%d\n", in sdw_transfer_defer()
251 msg->dev_num, ret); in sdw_transfer_defer()
253 if (msg->page) in sdw_transfer_defer()
254 sdw_reset_page(bus, msg->dev_num); in sdw_transfer_defer()
261 u32 addr, size_t count, u16 dev_num, u8 flags, u8 *buf) in sdw_fill_msg() argument
264 msg->addr = addr; /* addr is 16 bit and truncated here */ in sdw_fill_msg()
265 msg->len = count; in sdw_fill_msg()
266 msg->dev_num = dev_num; in sdw_fill_msg()
267 msg->flags = flags; in sdw_fill_msg()
268 msg->buf = buf; in sdw_fill_msg()
269 msg->ssp_sync = false; in sdw_fill_msg()
270 msg->page = false; in sdw_fill_msg()
272 if (addr < SDW_REG_NO_PAGE) { /* no paging area */ in sdw_fill_msg()
274 } else if (addr >= SDW_REG_MAX) { /* illegal addr */ in sdw_fill_msg()
275 pr_err("SDW: Invalid address %x passed\n", addr); in sdw_fill_msg()
276 return -EINVAL; in sdw_fill_msg()
279 if (addr < SDW_REG_OPTIONAL_PAGE) { /* 32k but no page */ in sdw_fill_msg()
280 if (slave && !slave->prop.paging_support) in sdw_fill_msg()
288 return -EINVAL; in sdw_fill_msg()
292 pr_err("SDW: No slave for paging addr\n"); in sdw_fill_msg()
293 return -EINVAL; in sdw_fill_msg()
294 } else if (!slave->prop.paging_support) { in sdw_fill_msg()
295 dev_err(&slave->dev, in sdw_fill_msg()
296 "address %x needs paging but no support", addr); in sdw_fill_msg()
297 return -EINVAL; in sdw_fill_msg()
300 msg->addr_page1 = (addr >> SDW_REG_SHIFT(SDW_SCP_ADDRPAGE1_MASK)); in sdw_fill_msg()
301 msg->addr_page2 = (addr >> SDW_REG_SHIFT(SDW_SCP_ADDRPAGE2_MASK)); in sdw_fill_msg()
302 msg->addr |= BIT(15); in sdw_fill_msg()
303 msg->page = true; in sdw_fill_msg()
309 * sdw_nread() - Read "n" contiguous SDW Slave registers
311 * @addr: Register address
315 int sdw_nread(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nread() argument
320 ret = sdw_fill_msg(&msg, slave, addr, count, in sdw_nread()
321 slave->dev_num, SDW_MSG_FLAG_READ, val); in sdw_nread()
325 ret = pm_runtime_get_sync(slave->bus->dev); in sdw_nread()
329 ret = sdw_transfer(slave->bus, &msg); in sdw_nread()
330 pm_runtime_put(slave->bus->dev); in sdw_nread()
337 * sdw_nwrite() - Write "n" contiguous SDW Slave registers
339 * @addr: Register address
343 int sdw_nwrite(struct sdw_slave *slave, u32 addr, size_t count, u8 *val) in sdw_nwrite() argument
348 ret = sdw_fill_msg(&msg, slave, addr, count, in sdw_nwrite()
349 slave->dev_num, SDW_MSG_FLAG_WRITE, val); in sdw_nwrite()
353 ret = pm_runtime_get_sync(slave->bus->dev); in sdw_nwrite()
357 ret = sdw_transfer(slave->bus, &msg); in sdw_nwrite()
358 pm_runtime_put(slave->bus->dev); in sdw_nwrite()
365 * sdw_read() - Read a SDW Slave register
367 * @addr: Register address
369 int sdw_read(struct sdw_slave *slave, u32 addr) in sdw_read() argument
374 ret = sdw_nread(slave, addr, 1, &buf); in sdw_read()
383 * sdw_write() - Write a SDW Slave register
385 * @addr: Register address
388 int sdw_write(struct sdw_slave *slave, u32 addr, u8 value) in sdw_write() argument
390 return sdw_nwrite(slave, addr, 1, &value); in sdw_write()
400 static struct sdw_slave *sdw_get_slave(struct sdw_bus *bus, int i) in sdw_get_slave() argument
404 list_for_each_entry(slave, &bus->slaves, node) { in sdw_get_slave()
405 if (slave->dev_num == i) in sdw_get_slave()
415 if ((slave->id.unique_id != id.unique_id) || in sdw_compare_devid()
416 (slave->id.mfg_id != id.mfg_id) || in sdw_compare_devid()
417 (slave->id.part_id != id.part_id) || in sdw_compare_devid()
418 (slave->id.class_id != id.class_id)) in sdw_compare_devid()
419 return -ENODEV; in sdw_compare_devid()
429 bit = find_first_zero_bit(slave->bus->assigned, SDW_MAX_DEVICES); in sdw_get_device_num()
431 bit = -ENODEV; in sdw_get_device_num()
439 set_bit(bit, slave->bus->assigned); in sdw_get_device_num()
450 if (!slave->dev_num) { in sdw_assign_device_num()
451 mutex_lock(&slave->bus->bus_lock); in sdw_assign_device_num()
453 mutex_unlock(&slave->bus->bus_lock); in sdw_assign_device_num()
455 dev_err(slave->bus->dev, "Get dev_num failed: %d", in sdw_assign_device_num()
460 dev_info(slave->bus->dev, in sdw_assign_device_num()
462 slave->dev_num); in sdw_assign_device_num()
464 /* Clear the slave->dev_num to transfer message on device 0 */ in sdw_assign_device_num()
465 dev_num = slave->dev_num; in sdw_assign_device_num()
466 slave->dev_num = 0; in sdw_assign_device_num()
472 dev_err(&slave->dev, "Program device_num failed: %d", ret); in sdw_assign_device_num()
477 slave->dev_num = dev_num; in sdw_assign_device_num()
482 void sdw_extract_slave_id(struct sdw_bus *bus, in sdw_extract_slave_id() argument
483 u64 addr, struct sdw_slave_id *id) in sdw_extract_slave_id() argument
485 dev_dbg(bus->dev, "SDW Slave Addr: %llx", addr); in sdw_extract_slave_id()
498 id->sdw_version = (addr >> 44) & GENMASK(3, 0); in sdw_extract_slave_id()
499 id->unique_id = (addr >> 40) & GENMASK(3, 0); in sdw_extract_slave_id()
500 id->mfg_id = (addr >> 24) & GENMASK(15, 0); in sdw_extract_slave_id()
501 id->part_id = (addr >> 8) & GENMASK(15, 0); in sdw_extract_slave_id()
502 id->class_id = addr & GENMASK(7, 0); in sdw_extract_slave_id()
504 dev_dbg(bus->dev, in sdw_extract_slave_id()
506 id->class_id, id->part_id, id->mfg_id, in sdw_extract_slave_id()
507 id->unique_id, id->sdw_version); in sdw_extract_slave_id()
511 static int sdw_program_device_num(struct sdw_bus *bus) in sdw_program_device_num() argument
519 u64 addr; in sdw_program_device_num() local
528 ret = sdw_transfer(bus, &msg); in sdw_program_device_num()
529 if (ret == -ENODATA) { /* end of device id reads */ in sdw_program_device_num()
534 dev_err(bus->dev, "DEVID read fail:%d\n", ret); in sdw_program_device_num()
539 * Construct the addr and extract. Cast the higher shift in sdw_program_device_num()
542 addr = buf[5] | (buf[4] << 8) | (buf[3] << 16) | in sdw_program_device_num()
546 sdw_extract_slave_id(bus, addr, &id); in sdw_program_device_num()
549 list_for_each_entry_safe(slave, _s, &bus->slaves, node) { in sdw_program_device_num()
561 dev_err(slave->bus->dev, in sdw_program_device_num()
573 dev_err(bus->dev, "Slave Entry not found"); in sdw_program_device_num()
592 mutex_lock(&slave->bus->bus_lock); in sdw_modify_slave_status()
593 slave->status = status; in sdw_modify_slave_status()
594 mutex_unlock(&slave->bus->bus_lock); in sdw_modify_slave_status()
600 u32 addr; in sdw_configure_dpn_intr() local
604 addr = SDW_DPN_INTMASK(port); in sdw_configure_dpn_intr()
615 ret = sdw_update(slave, addr, (mask | SDW_DPN_INT_PORT_READY), val); in sdw_configure_dpn_intr()
617 dev_err(slave->bus->dev, in sdw_configure_dpn_intr()
625 struct sdw_slave_prop *prop = &slave->prop; in sdw_initialize_slave()
630 * Set bus clash, parity and SCP implementation in sdw_initialize_slave()
641 dev_err(slave->bus->dev, in sdw_initialize_slave()
647 if (!slave->prop.dp0_prop) in sdw_initialize_slave()
651 val = prop->dp0_prop->device_interrupts; in sdw_initialize_slave()
656 dev_err(slave->bus->dev, in sdw_initialize_slave()
671 dev_err(slave->bus->dev, in sdw_handle_dp0_interrupt()
679 dev_err(&slave->dev, "Test fail for port 0"); in sdw_handle_dp0_interrupt()
689 complete(&slave->port_ready[0]); in sdw_handle_dp0_interrupt()
694 dev_err(&slave->dev, "BRA failed"); in sdw_handle_dp0_interrupt()
709 dev_err(slave->bus->dev, in sdw_handle_dp0_interrupt()
717 dev_err(slave->bus->dev, in sdw_handle_dp0_interrupt()
729 dev_warn(slave->bus->dev, "Reached MAX_RETRY on DP0 read"); in sdw_handle_dp0_interrupt()
739 u32 addr; in sdw_handle_port_interrupt() local
744 addr = SDW_DPN_INT(port); in sdw_handle_port_interrupt()
745 status = sdw_read(slave, addr); in sdw_handle_port_interrupt()
747 dev_err(slave->bus->dev, in sdw_handle_port_interrupt()
756 dev_err(&slave->dev, "Test fail for port:%d", port); in sdw_handle_port_interrupt()
765 complete(&slave->port_ready[port]); in sdw_handle_port_interrupt()
779 ret = sdw_write(slave, addr, clear); in sdw_handle_port_interrupt()
781 dev_err(slave->bus->dev, in sdw_handle_port_interrupt()
787 status2 = sdw_read(slave, addr); in sdw_handle_port_interrupt()
789 dev_err(slave->bus->dev, in sdw_handle_port_interrupt()
801 dev_warn(slave->bus->dev, "Reached MAX_RETRY on port read"); in sdw_handle_port_interrupt()
820 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
827 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
834 * Check parity, bus clash and Slave (impl defined) in sdw_handle_slave_alerts()
838 dev_err(&slave->dev, "Parity error detected"); in sdw_handle_slave_alerts()
843 dev_err(&slave->dev, "Bus clash error detected"); in sdw_handle_slave_alerts()
848 * When bus clash or parity errors are detected, such errors in sdw_handle_slave_alerts()
850 * TODO: In such scenario, reset bus. Make this configurable in sdw_handle_slave_alerts()
851 * via sysfs property with bus reset being the default. in sdw_handle_slave_alerts()
855 dev_dbg(&slave->dev, "Slave impl defined interrupt\n"); in sdw_handle_slave_alerts()
860 /* Check port 0 - 3 interrupts */ in sdw_handle_slave_alerts()
896 if (slave_notify && (slave->ops) && in sdw_handle_slave_alerts()
897 (slave->ops->interrupt_callback)) { in sdw_handle_slave_alerts()
902 slave->ops->interrupt_callback(slave, &slave_intr); in sdw_handle_slave_alerts()
908 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
919 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
926 dev_err(slave->bus->dev, in sdw_handle_slave_alerts()
947 dev_warn(slave->bus->dev, "Reached MAX_RETRY on alert read"); in sdw_handle_slave_alerts()
955 if ((slave->ops) && (slave->ops->update_status)) in sdw_update_slave_status()
956 return slave->ops->update_status(slave, status); in sdw_update_slave_status()
962 * sdw_handle_slave_status() - Handle Slave status
963 * @bus: SDW bus instance
966 int sdw_handle_slave_status(struct sdw_bus *bus, in sdw_handle_slave_status() argument
974 ret = sdw_program_device_num(bus); in sdw_handle_slave_status()
976 dev_err(bus->dev, "Slave attach failed: %d", ret); in sdw_handle_slave_status()
981 mutex_lock(&bus->bus_lock); in sdw_handle_slave_status()
982 if (test_bit(i, bus->assigned) == false) { in sdw_handle_slave_status()
983 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
986 mutex_unlock(&bus->bus_lock); in sdw_handle_slave_status()
988 slave = sdw_get_slave(bus, i); in sdw_handle_slave_status()
994 if (slave->status == SDW_SLAVE_UNATTACHED) in sdw_handle_slave_status()
1003 dev_err(bus->dev, in sdw_handle_slave_status()
1009 if (slave->status == SDW_SLAVE_ATTACHED) in sdw_handle_slave_status()
1012 prev_status = slave->status; in sdw_handle_slave_status()
1020 dev_err(bus->dev, in sdw_handle_slave_status()
1027 dev_err(bus->dev, "Invalid slave %d status:%d", in sdw_handle_slave_status()
1034 dev_err(slave->bus->dev, in sdw_handle_slave_status()