Lines Matching full:pcs
210 #define PCS_QUIRK_HAS_SHARED_IRQ (pcs->flags & PCS_QUIRK_SHARED_IRQ)
211 #define PCS_HAS_IRQ (pcs->flags & PCS_FEAT_IRQ)
212 #define PCS_HAS_PINCONF (pcs->flags & PCS_FEAT_PINCONF)
273 static unsigned int pcs_pin_reg_offset_get(struct pcs_device *pcs, in pcs_pin_reg_offset_get() argument
276 unsigned int mux_bytes = pcs->width / BITS_PER_BYTE; in pcs_pin_reg_offset_get()
278 if (pcs->bits_per_mux) { in pcs_pin_reg_offset_get()
281 pin_offset_bytes = (pcs->bits_per_pin * pin) / BITS_PER_BYTE; in pcs_pin_reg_offset_get()
288 static unsigned int pcs_pin_shift_reg_get(struct pcs_device *pcs, in pcs_pin_shift_reg_get() argument
291 return (pin % (pcs->width / pcs->bits_per_pin)) * pcs->bits_per_pin; in pcs_pin_shift_reg_get()
298 struct pcs_device *pcs; in pcs_pin_dbg_show() local
303 pcs = pinctrl_dev_get_drvdata(pctldev); in pcs_pin_dbg_show()
305 offset = pcs_pin_reg_offset_get(pcs, pin); in pcs_pin_dbg_show()
306 val = pcs->read(pcs->base + offset); in pcs_pin_dbg_show()
308 if (pcs->bits_per_mux) in pcs_pin_dbg_show()
309 val &= pcs->fmask << pcs_pin_shift_reg_get(pcs, pin); in pcs_pin_dbg_show()
311 pa = pcs->res->start + offset; in pcs_pin_dbg_show()
319 struct pcs_device *pcs; in pcs_dt_free_map() local
321 pcs = pinctrl_dev_get_drvdata(pctldev); in pcs_dt_free_map()
322 devm_kfree(pcs->dev, map); in pcs_dt_free_map()
341 struct pcs_device *pcs = pinctrl_dev_get_drvdata(pctldev); in pcs_get_function() local
355 dev_err(pcs->dev, "%s could not find function%i\n", in pcs_get_function()
365 struct pcs_device *pcs; in pcs_set_mux() local
370 pcs = pinctrl_dev_get_drvdata(pctldev); in pcs_set_mux()
372 if (!pcs->fmask) in pcs_set_mux()
379 dev_dbg(pcs->dev, "enabling %s function%i\n", in pcs_set_mux()
388 raw_spin_lock_irqsave(&pcs->lock, flags); in pcs_set_mux()
389 val = pcs->read(vals->reg); in pcs_set_mux()
391 if (pcs->bits_per_mux) in pcs_set_mux()
394 mask = pcs->fmask; in pcs_set_mux()
398 pcs->write(val, vals->reg); in pcs_set_mux()
399 raw_spin_unlock_irqrestore(&pcs->lock, flags); in pcs_set_mux()
408 struct pcs_device *pcs = pinctrl_dev_get_drvdata(pctldev); in pcs_request_gpio() local
414 if (!pcs->fmask) in pcs_request_gpio()
417 list_for_each_safe(pos, tmp, &pcs->gpiofuncs) { in pcs_request_gpio()
425 offset = pcs_pin_reg_offset_get(pcs, pin); in pcs_request_gpio()
427 if (pcs->bits_per_mux) { in pcs_request_gpio()
428 int pin_shift = pcs_pin_shift_reg_get(pcs, pin); in pcs_request_gpio()
430 data = pcs->read(pcs->base + offset); in pcs_request_gpio()
431 data &= ~(pcs->fmask << pin_shift); in pcs_request_gpio()
433 pcs->write(data, pcs->base + offset); in pcs_request_gpio()
435 data = pcs->read(pcs->base + offset); in pcs_request_gpio()
436 data &= ~pcs->fmask; in pcs_request_gpio()
438 pcs->write(data, pcs->base + offset); in pcs_request_gpio()
486 struct pcs_device *pcs = pinctrl_dev_get_drvdata(pctldev); in pcs_pinconf_get() local
508 offset = pin * (pcs->width / BITS_PER_BYTE); in pcs_pinconf_get()
509 data = pcs->read(pcs->base + offset) & func->conf[i].mask; in pcs_pinconf_get()
550 struct pcs_device *pcs = pinctrl_dev_get_drvdata(pctldev); in pcs_pinconf_set() local
566 offset = pin * (pcs->width / BITS_PER_BYTE); in pcs_pinconf_set()
567 data = pcs->read(pcs->base + offset); in pcs_pinconf_set()
598 pcs->write(data, pcs->base + offset); in pcs_pinconf_set()
678 * @pcs: pcs driver instance
681 static int pcs_add_pin(struct pcs_device *pcs, unsigned int offset) in pcs_add_pin() argument
683 struct pcs_soc_data *pcs_soc = &pcs->socdata; in pcs_add_pin()
687 i = pcs->pins.cur; in pcs_add_pin()
688 if (i >= pcs->desc.npins) { in pcs_add_pin()
689 dev_err(pcs->dev, "too many pins, max %i\n", in pcs_add_pin()
690 pcs->desc.npins); in pcs_add_pin()
697 val = pcs->read(pcs->base + offset); in pcs_add_pin()
699 dev_dbg(pcs->dev, "irq enabled at boot for pin at %lx (%x), clearing\n", in pcs_add_pin()
700 (unsigned long)pcs->res->start + offset, val); in pcs_add_pin()
702 pcs->write(val, pcs->base + offset); in pcs_add_pin()
706 pin = &pcs->pins.pa[i]; in pcs_add_pin()
708 pcs->pins.cur++; in pcs_add_pin()
715 * @pcs: pcs driver instance
722 static int pcs_allocate_pin_table(struct pcs_device *pcs) in pcs_allocate_pin_table() argument
727 mux_bytes = pcs->width / BITS_PER_BYTE; in pcs_allocate_pin_table()
729 if (pcs->bits_per_mux && pcs->fmask) { in pcs_allocate_pin_table()
730 pcs->bits_per_pin = fls(pcs->fmask); in pcs_allocate_pin_table()
731 nr_pins = (pcs->size * BITS_PER_BYTE) / pcs->bits_per_pin; in pcs_allocate_pin_table()
732 num_pins_in_register = pcs->width / pcs->bits_per_pin; in pcs_allocate_pin_table()
734 nr_pins = pcs->size / mux_bytes; in pcs_allocate_pin_table()
737 dev_dbg(pcs->dev, "allocating %i pins\n", nr_pins); in pcs_allocate_pin_table()
738 pcs->pins.pa = devm_kcalloc(pcs->dev, in pcs_allocate_pin_table()
739 nr_pins, sizeof(*pcs->pins.pa), in pcs_allocate_pin_table()
741 if (!pcs->pins.pa) in pcs_allocate_pin_table()
744 pcs->desc.pins = pcs->pins.pa; in pcs_allocate_pin_table()
745 pcs->desc.npins = nr_pins; in pcs_allocate_pin_table()
747 for (i = 0; i < pcs->desc.npins; i++) { in pcs_allocate_pin_table()
751 offset = pcs_pin_reg_offset_get(pcs, i); in pcs_allocate_pin_table()
752 res = pcs_add_pin(pcs, offset); in pcs_allocate_pin_table()
754 dev_err(pcs->dev, "error adding pins: %i\n", res); in pcs_allocate_pin_table()
764 * @pcs: pcs driver instance
774 static int pcs_add_function(struct pcs_device *pcs, in pcs_add_function() argument
785 function = devm_kzalloc(pcs->dev, sizeof(*function), GFP_KERNEL); in pcs_add_function()
792 selector = pinmux_generic_add_function(pcs->pctl, name, in pcs_add_function()
796 devm_kfree(pcs->dev, function); in pcs_add_function()
807 * @pcs: pcs driver instance
812 static int pcs_get_pin_by_offset(struct pcs_device *pcs, unsigned offset) in pcs_get_pin_by_offset() argument
816 if (offset >= pcs->size) { in pcs_get_pin_by_offset()
817 dev_err(pcs->dev, "mux offset out of range: 0x%x (0x%x)\n", in pcs_get_pin_by_offset()
818 offset, pcs->size); in pcs_get_pin_by_offset()
822 if (pcs->bits_per_mux) in pcs_get_pin_by_offset()
823 index = (offset * BITS_PER_BYTE) / pcs->bits_per_pin; in pcs_get_pin_by_offset()
825 index = offset / (pcs->width / BITS_PER_BYTE); in pcs_get_pin_by_offset()
866 static void pcs_add_conf2(struct pcs_device *pcs, struct device_node *np, in pcs_add_conf2() argument
885 static void pcs_add_conf4(struct pcs_device *pcs, struct device_node *np, in pcs_add_conf4() argument
897 dev_err(pcs->dev, "mask field of the property can't be 0\n"); in pcs_add_conf4()
905 dev_dbg(pcs->dev, "failed to match enable or disable bits\n"); in pcs_add_conf4()
910 static int pcs_parse_pinconf(struct pcs_device *pcs, struct device_node *np, in pcs_parse_pinconf() argument
948 func->conf = devm_kcalloc(pcs->dev, in pcs_parse_pinconf()
956 settings = devm_kcalloc(pcs->dev, nconfs, sizeof(unsigned long), in pcs_parse_pinconf()
963 pcs_add_conf2(pcs, np, prop2[i].name, prop2[i].param, in pcs_parse_pinconf()
966 pcs_add_conf4(pcs, np, prop4[i].name, prop4[i].param, in pcs_parse_pinconf()
977 * @pcs: pinctrl driver instance
994 static int pcs_parse_one_pinctrl_entry(struct pcs_device *pcs, in pcs_parse_one_pinctrl_entry() argument
1007 dev_err(pcs->dev, "Invalid number of rows: %d\n", rows); in pcs_parse_one_pinctrl_entry()
1011 vals = devm_kcalloc(pcs->dev, rows, sizeof(*vals), GFP_KERNEL); in pcs_parse_one_pinctrl_entry()
1015 pins = devm_kcalloc(pcs->dev, rows, sizeof(*pins), GFP_KERNEL); in pcs_parse_one_pinctrl_entry()
1029 dev_err(pcs->dev, "invalid args_count for spec: %i\n", in pcs_parse_one_pinctrl_entry()
1035 vals[found].reg = pcs->base + offset; in pcs_parse_one_pinctrl_entry()
1046 dev_dbg(pcs->dev, "%pOFn index: 0x%x value: 0x%x\n", in pcs_parse_one_pinctrl_entry()
1049 pin = pcs_get_pin_by_offset(pcs, offset); in pcs_parse_one_pinctrl_entry()
1051 dev_err(pcs->dev, in pcs_parse_one_pinctrl_entry()
1060 mutex_lock(&pcs->mutex); in pcs_parse_one_pinctrl_entry()
1061 fsel = pcs_add_function(pcs, &function, np->name, vals, found, in pcs_parse_one_pinctrl_entry()
1068 gsel = pinctrl_generic_add_group(pcs->pctl, np->name, pins, found, pcs); in pcs_parse_one_pinctrl_entry()
1079 res = pcs_parse_pinconf(pcs, np, function, map); in pcs_parse_one_pinctrl_entry()
1089 mutex_unlock(&pcs->mutex); in pcs_parse_one_pinctrl_entry()
1094 pinctrl_generic_remove_group(pcs->pctl, gsel); in pcs_parse_one_pinctrl_entry()
1097 pinmux_generic_remove_function(pcs->pctl, fsel); in pcs_parse_one_pinctrl_entry()
1099 mutex_unlock(&pcs->mutex); in pcs_parse_one_pinctrl_entry()
1100 devm_kfree(pcs->dev, pins); in pcs_parse_one_pinctrl_entry()
1103 devm_kfree(pcs->dev, vals); in pcs_parse_one_pinctrl_entry()
1108 static int pcs_parse_bits_in_pinctrl_entry(struct pcs_device *pcs, in pcs_parse_bits_in_pinctrl_entry() argument
1122 dev_err(pcs->dev, "Invalid number of rows: %d\n", rows); in pcs_parse_bits_in_pinctrl_entry()
1126 npins_in_row = pcs->width / pcs->bits_per_pin; in pcs_parse_bits_in_pinctrl_entry()
1128 vals = devm_kzalloc(pcs->dev, in pcs_parse_bits_in_pinctrl_entry()
1134 pins = devm_kzalloc(pcs->dev, in pcs_parse_bits_in_pinctrl_entry()
1152 dev_err(pcs->dev, "invalid args_count for spec: %i\n", in pcs_parse_bits_in_pinctrl_entry()
1162 dev_dbg(pcs->dev, "%pOFn index: 0x%x value: 0x%x mask: 0x%x\n", in pcs_parse_bits_in_pinctrl_entry()
1168 pin_num_from_lsb = bit_pos / pcs->bits_per_pin; in pcs_parse_bits_in_pinctrl_entry()
1169 mask_pos = ((pcs->fmask) << bit_pos); in pcs_parse_bits_in_pinctrl_entry()
1174 dev_err(pcs->dev, in pcs_parse_bits_in_pinctrl_entry()
1183 dev_warn(pcs->dev, in pcs_parse_bits_in_pinctrl_entry()
1190 vals[found].reg = pcs->base + offset; in pcs_parse_bits_in_pinctrl_entry()
1193 pin = pcs_get_pin_by_offset(pcs, offset); in pcs_parse_bits_in_pinctrl_entry()
1195 dev_err(pcs->dev, in pcs_parse_bits_in_pinctrl_entry()
1205 mutex_lock(&pcs->mutex); in pcs_parse_bits_in_pinctrl_entry()
1206 fsel = pcs_add_function(pcs, &function, np->name, vals, found, in pcs_parse_bits_in_pinctrl_entry()
1213 gsel = pinctrl_generic_add_group(pcs->pctl, np->name, pins, found, pcs); in pcs_parse_bits_in_pinctrl_entry()
1224 dev_err(pcs->dev, "pinconf not supported\n"); in pcs_parse_bits_in_pinctrl_entry()
1230 mutex_unlock(&pcs->mutex); in pcs_parse_bits_in_pinctrl_entry()
1235 pinctrl_generic_remove_group(pcs->pctl, gsel); in pcs_parse_bits_in_pinctrl_entry()
1238 pinmux_generic_remove_function(pcs->pctl, fsel); in pcs_parse_bits_in_pinctrl_entry()
1240 mutex_unlock(&pcs->mutex); in pcs_parse_bits_in_pinctrl_entry()
1241 devm_kfree(pcs->dev, pins); in pcs_parse_bits_in_pinctrl_entry()
1244 devm_kfree(pcs->dev, vals); in pcs_parse_bits_in_pinctrl_entry()
1259 struct pcs_device *pcs; in pcs_dt_node_to_map() local
1263 pcs = pinctrl_dev_get_drvdata(pctldev); in pcs_dt_node_to_map()
1266 *map = devm_kcalloc(pcs->dev, 2, sizeof(**map), GFP_KERNEL); in pcs_dt_node_to_map()
1272 pgnames = devm_kzalloc(pcs->dev, sizeof(*pgnames), GFP_KERNEL); in pcs_dt_node_to_map()
1278 if (pcs->bits_per_mux) { in pcs_dt_node_to_map()
1279 ret = pcs_parse_bits_in_pinctrl_entry(pcs, np_config, map, in pcs_dt_node_to_map()
1282 dev_err(pcs->dev, "no pins entries for %pOFn\n", in pcs_dt_node_to_map()
1287 ret = pcs_parse_one_pinctrl_entry(pcs, np_config, map, in pcs_dt_node_to_map()
1290 dev_err(pcs->dev, "no pins entries for %pOFn\n", in pcs_dt_node_to_map()
1299 devm_kfree(pcs->dev, pgnames); in pcs_dt_node_to_map()
1301 devm_kfree(pcs->dev, *map); in pcs_dt_node_to_map()
1308 * @pcs: pcs driver instance
1310 static void pcs_irq_free(struct pcs_device *pcs) in pcs_irq_free() argument
1312 struct pcs_soc_data *pcs_soc = &pcs->socdata; in pcs_irq_free()
1317 if (pcs->domain) in pcs_irq_free()
1318 irq_domain_remove(pcs->domain); in pcs_irq_free()
1328 * @pcs: pcs driver instance
1330 static void pcs_free_resources(struct pcs_device *pcs) in pcs_free_resources() argument
1332 pcs_irq_free(pcs); in pcs_free_resources()
1333 pinctrl_unregister(pcs->pctl); in pcs_free_resources()
1336 if (pcs->missing_nr_pinctrl_cells) in pcs_free_resources()
1337 of_remove_property(pcs->np, pcs->missing_nr_pinctrl_cells); in pcs_free_resources()
1341 static int pcs_add_gpio_func(struct device_node *node, struct pcs_device *pcs) in pcs_add_gpio_func() argument
1357 range = devm_kzalloc(pcs->dev, sizeof(*range), GFP_KERNEL); in pcs_add_gpio_func()
1365 mutex_lock(&pcs->mutex); in pcs_add_gpio_func()
1366 list_add_tail(&range->node, &pcs->gpiofuncs); in pcs_add_gpio_func()
1367 mutex_unlock(&pcs->mutex); in pcs_add_gpio_func()
1398 struct pcs_device *pcs; in pcs_irq_set() local
1402 pcs = container_of(pcs_soc, struct pcs_device, socdata); in pcs_irq_set()
1403 list_for_each(pos, &pcs->irqs) { in pcs_irq_set()
1412 raw_spin_lock(&pcs->lock); in pcs_irq_set()
1413 mask = pcs->read(pcswi->reg); in pcs_irq_set()
1418 pcs->write(mask, pcswi->reg); in pcs_irq_set()
1421 mask = pcs->read(pcswi->reg); in pcs_irq_set()
1422 raw_spin_unlock(&pcs->lock); in pcs_irq_set()
1479 struct pcs_device *pcs; in pcs_irq_handle() local
1483 pcs = container_of(pcs_soc, struct pcs_device, socdata); in pcs_irq_handle()
1484 list_for_each(pos, &pcs->irqs) { in pcs_irq_handle()
1489 raw_spin_lock(&pcs->lock); in pcs_irq_handle()
1490 mask = pcs->read(pcswi->reg); in pcs_irq_handle()
1491 raw_spin_unlock(&pcs->lock); in pcs_irq_handle()
1493 generic_handle_irq(irq_find_mapping(pcs->domain, in pcs_irq_handle()
1540 struct pcs_device *pcs; in pcs_irqdomain_map() local
1543 pcs = container_of(pcs_soc, struct pcs_device, socdata); in pcs_irqdomain_map()
1544 pcswi = devm_kzalloc(pcs->dev, sizeof(*pcswi), GFP_KERNEL); in pcs_irqdomain_map()
1548 pcswi->reg = pcs->base + hwirq; in pcs_irqdomain_map()
1552 mutex_lock(&pcs->mutex); in pcs_irqdomain_map()
1553 list_add_tail(&pcswi->node, &pcs->irqs); in pcs_irqdomain_map()
1554 mutex_unlock(&pcs->mutex); in pcs_irqdomain_map()
1557 irq_set_chip_and_handler(irq, &pcs->chip, in pcs_irqdomain_map()
1572 * @pcs: pcs driver instance
1575 static int pcs_irq_init_chained_handler(struct pcs_device *pcs, in pcs_irq_init_chained_handler() argument
1578 struct pcs_soc_data *pcs_soc = &pcs->socdata; in pcs_irq_init_chained_handler()
1588 INIT_LIST_HEAD(&pcs->irqs); in pcs_irq_init_chained_handler()
1589 pcs->chip.name = name; in pcs_irq_init_chained_handler()
1590 pcs->chip.irq_ack = pcs_irq_mask; in pcs_irq_init_chained_handler()
1591 pcs->chip.irq_mask = pcs_irq_mask; in pcs_irq_init_chained_handler()
1592 pcs->chip.irq_unmask = pcs_irq_unmask; in pcs_irq_init_chained_handler()
1593 pcs->chip.irq_set_wake = pcs_irq_set_wake; in pcs_irq_init_chained_handler()
1618 num_irqs = pcs->size; in pcs_irq_init_chained_handler()
1620 pcs->domain = irq_domain_add_simple(np, num_irqs, 0, in pcs_irq_init_chained_handler()
1623 if (!pcs->domain) { in pcs_irq_init_chained_handler()
1632 static int pcs_save_context(struct pcs_device *pcs) in pcs_save_context() argument
1639 mux_bytes = pcs->width / BITS_PER_BYTE; in pcs_save_context()
1641 if (!pcs->saved_vals) { in pcs_save_context()
1642 pcs->saved_vals = devm_kzalloc(pcs->dev, pcs->size, GFP_ATOMIC); in pcs_save_context()
1643 if (!pcs->saved_vals) in pcs_save_context()
1647 switch (pcs->width) { in pcs_save_context()
1649 regsl = pcs->saved_vals; in pcs_save_context()
1650 for (i = 0; i < pcs->size; i += mux_bytes) in pcs_save_context()
1651 *regsl++ = pcs->read(pcs->base + i); in pcs_save_context()
1654 regsw = pcs->saved_vals; in pcs_save_context()
1655 for (i = 0; i < pcs->size; i += mux_bytes) in pcs_save_context()
1656 *regsw++ = pcs->read(pcs->base + i); in pcs_save_context()
1659 regshw = pcs->saved_vals; in pcs_save_context()
1660 for (i = 0; i < pcs->size; i += mux_bytes) in pcs_save_context()
1661 *regshw++ = pcs->read(pcs->base + i); in pcs_save_context()
1668 static void pcs_restore_context(struct pcs_device *pcs) in pcs_restore_context() argument
1675 mux_bytes = pcs->width / BITS_PER_BYTE; in pcs_restore_context()
1677 switch (pcs->width) { in pcs_restore_context()
1679 regsl = pcs->saved_vals; in pcs_restore_context()
1680 for (i = 0; i < pcs->size; i += mux_bytes) in pcs_restore_context()
1681 pcs->write(*regsl++, pcs->base + i); in pcs_restore_context()
1684 regsw = pcs->saved_vals; in pcs_restore_context()
1685 for (i = 0; i < pcs->size; i += mux_bytes) in pcs_restore_context()
1686 pcs->write(*regsw++, pcs->base + i); in pcs_restore_context()
1689 regshw = pcs->saved_vals; in pcs_restore_context()
1690 for (i = 0; i < pcs->size; i += mux_bytes) in pcs_restore_context()
1691 pcs->write(*regshw++, pcs->base + i); in pcs_restore_context()
1699 struct pcs_device *pcs; in pinctrl_single_suspend() local
1701 pcs = platform_get_drvdata(pdev); in pinctrl_single_suspend()
1702 if (!pcs) in pinctrl_single_suspend()
1705 if (pcs->flags & PCS_CONTEXT_LOSS_OFF) { in pinctrl_single_suspend()
1708 ret = pcs_save_context(pcs); in pinctrl_single_suspend()
1713 return pinctrl_force_sleep(pcs->pctl); in pinctrl_single_suspend()
1718 struct pcs_device *pcs; in pinctrl_single_resume() local
1720 pcs = platform_get_drvdata(pdev); in pinctrl_single_resume()
1721 if (!pcs) in pinctrl_single_resume()
1724 if (pcs->flags & PCS_CONTEXT_LOSS_OFF) in pinctrl_single_resume()
1725 pcs_restore_context(pcs); in pinctrl_single_resume()
1727 return pinctrl_force_default(pcs->pctl); in pinctrl_single_resume()
1733 * @pcs: pinctrl driver instance
1741 static int pcs_quirk_missing_pinctrl_cells(struct pcs_device *pcs, in pcs_quirk_missing_pinctrl_cells() argument
1754 dev_warn(pcs->dev, "please update dts to use %s = <%i>\n", in pcs_quirk_missing_pinctrl_cells()
1757 p = devm_kzalloc(pcs->dev, sizeof(*p), GFP_KERNEL); in pcs_quirk_missing_pinctrl_cells()
1762 p->value = devm_kzalloc(pcs->dev, sizeof(__be32), GFP_KERNEL); in pcs_quirk_missing_pinctrl_cells()
1767 p->name = devm_kstrdup(pcs->dev, name, GFP_KERNEL); in pcs_quirk_missing_pinctrl_cells()
1771 pcs->missing_nr_pinctrl_cells = p; in pcs_quirk_missing_pinctrl_cells()
1774 error = of_add_property(np, pcs->missing_nr_pinctrl_cells); in pcs_quirk_missing_pinctrl_cells()
1785 struct pcs_device *pcs; in pcs_probe() local
1793 pcs = devm_kzalloc(&pdev->dev, sizeof(*pcs), GFP_KERNEL); in pcs_probe()
1794 if (!pcs) in pcs_probe()
1797 pcs->dev = &pdev->dev; in pcs_probe()
1798 pcs->np = np; in pcs_probe()
1799 raw_spin_lock_init(&pcs->lock); in pcs_probe()
1800 mutex_init(&pcs->mutex); in pcs_probe()
1801 INIT_LIST_HEAD(&pcs->gpiofuncs); in pcs_probe()
1802 pcs->flags = soc->flags; in pcs_probe()
1803 memcpy(&pcs->socdata, soc, sizeof(*soc)); in pcs_probe()
1806 &pcs->width); in pcs_probe()
1808 dev_err(pcs->dev, "register width not specified\n"); in pcs_probe()
1814 &pcs->fmask); in pcs_probe()
1816 pcs->fshift = __ffs(pcs->fmask); in pcs_probe()
1817 pcs->fmax = pcs->fmask >> pcs->fshift; in pcs_probe()
1820 pcs->fmask = 0; in pcs_probe()
1821 pcs->fshift = 0; in pcs_probe()
1822 pcs->fmax = 0; in pcs_probe()
1826 &pcs->foff); in pcs_probe()
1828 pcs->foff = PCS_OFF_DISABLED; in pcs_probe()
1830 pcs->bits_per_mux = of_property_read_bool(np, in pcs_probe()
1832 ret = pcs_quirk_missing_pinctrl_cells(pcs, np, in pcs_probe()
1833 pcs->bits_per_mux ? 2 : 1); in pcs_probe()
1842 dev_err(pcs->dev, "could not get resource\n"); in pcs_probe()
1846 pcs->res = devm_request_mem_region(pcs->dev, res->start, in pcs_probe()
1848 if (!pcs->res) { in pcs_probe()
1849 dev_err(pcs->dev, "could not get mem_region\n"); in pcs_probe()
1853 pcs->size = resource_size(pcs->res); in pcs_probe()
1854 pcs->base = devm_ioremap(pcs->dev, pcs->res->start, pcs->size); in pcs_probe()
1855 if (!pcs->base) { in pcs_probe()
1856 dev_err(pcs->dev, "could not ioremap\n"); in pcs_probe()
1860 platform_set_drvdata(pdev, pcs); in pcs_probe()
1862 switch (pcs->width) { in pcs_probe()
1864 pcs->read = pcs_readb; in pcs_probe()
1865 pcs->write = pcs_writeb; in pcs_probe()
1868 pcs->read = pcs_readw; in pcs_probe()
1869 pcs->write = pcs_writew; in pcs_probe()
1872 pcs->read = pcs_readl; in pcs_probe()
1873 pcs->write = pcs_writel; in pcs_probe()
1879 pcs->desc.name = DRIVER_NAME; in pcs_probe()
1880 pcs->desc.pctlops = &pcs_pinctrl_ops; in pcs_probe()
1881 pcs->desc.pmxops = &pcs_pinmux_ops; in pcs_probe()
1883 pcs->desc.confops = &pcs_pinconf_ops; in pcs_probe()
1884 pcs->desc.owner = THIS_MODULE; in pcs_probe()
1886 ret = pcs_allocate_pin_table(pcs); in pcs_probe()
1890 ret = pinctrl_register_and_init(&pcs->desc, pcs->dev, pcs, &pcs->pctl); in pcs_probe()
1892 dev_err(pcs->dev, "could not register single pinctrl driver\n"); in pcs_probe()
1896 ret = pcs_add_gpio_func(np, pcs); in pcs_probe()
1900 pcs->socdata.irq = irq_of_parse_and_map(np, 0); in pcs_probe()
1901 if (pcs->socdata.irq) in pcs_probe()
1902 pcs->flags |= PCS_FEAT_IRQ; in pcs_probe()
1908 pcs->socdata.rearm = pdata->rearm; in pcs_probe()
1910 pcs->socdata.irq = pdata->irq; in pcs_probe()
1911 pcs->flags |= PCS_FEAT_IRQ; in pcs_probe()
1916 ret = pcs_irq_init_chained_handler(pcs, np); in pcs_probe()
1918 dev_warn(pcs->dev, "initialized with no interrupts\n"); in pcs_probe()
1921 dev_info(pcs->dev, "%i pins, size %u\n", pcs->desc.npins, pcs->size); in pcs_probe()
1923 return pinctrl_enable(pcs->pctl); in pcs_probe()
1926 pcs_free_resources(pcs); in pcs_probe()
1933 struct pcs_device *pcs = platform_get_drvdata(pdev); in pcs_remove() local
1935 if (!pcs) in pcs_remove()
1938 pcs_free_resources(pcs); in pcs_remove()