pinctrl/bcm/pinctrl-nsp-mux.c

27 #include <linux/pinctrl/pinconf-generic.h>
28 #include <linux/pinctrl/pinconf.h>
29 #include <linux/pinctrl/pinctrl.h>
30 #include <linux/pinctrl/pinmux.h>
33 #include "../pinctrl-utils.h"
94  * nsp IOMUX pinctrl core
314 	struct nsp_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
316 	return pinctrl->num_groups;
322 	struct nsp_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
324 	return pinctrl->groups[selector].name;
331 	struct nsp_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
333 	*pins = pinctrl->groups[selector].pins;
334 	*num_pins = pinctrl->groups[selector].num_pins;
356 	struct nsp_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
358 	return pinctrl->num_functions;
364 	struct nsp_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
366 	return pinctrl->functions[selector].name;
374 	struct nsp_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
376 	*groups = pinctrl->functions[selector].groups;
377 	*num_groups = pinctrl->functions[selector].num_groups;
382 static int nsp_pinmux_set(struct nsp_pinctrl *pinctrl,
393 	for (i = 0; i < pinctrl->num_groups; i++) {
407 			dev_err(pinctrl->dev,
409 			dev_err(pinctrl->dev, "func:%s grp:%s\n",
416 	if (i == pinctrl->num_groups)
425 		base_address = pinctrl->base0;
429 		base_address = pinctrl->base1;
433 		base_address = pinctrl->base2;
440 	spin_lock_irqsave(&pinctrl->lock, flags);
445 	spin_unlock_irqrestore(&pinctrl->lock, flags);
453 	struct nsp_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
457 	if (grp_select >= pinctrl->num_groups ||
458 	    func_select >= pinctrl->num_functions)
461 	func = &pinctrl->functions[func_select];
462 	grp = &pinctrl->groups[grp_select];
470 	return nsp_pinmux_set(pinctrl, func, grp, pinctrl->mux_log);
478 	struct nsp_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
483 	spin_lock_irqsave(&pinctrl->lock, flags);
484 	val = readl(pinctrl->base0);
488 		writel(val, pinctrl->base0);
490 	spin_unlock_irqrestore(&pinctrl->lock, flags);
499 	struct nsp_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
504 	spin_lock_irqsave(&pinctrl->lock, flags);
505 	val = readl(pinctrl->base0);
510 		writel(val, pinctrl->base0);
512 	spin_unlock_irqrestore(&pinctrl->lock, flags);
531 static int nsp_mux_log_init(struct nsp_pinctrl *pinctrl)
537 	pinctrl->mux_log = devm_kcalloc(pinctrl->dev, no_of_groups,
540 	if (!pinctrl->mux_log)
544 		log = &pinctrl->mux_log[i];
556 	struct nsp_pinctrl *pinctrl;
561 	pinctrl = devm_kzalloc(&pdev->dev, sizeof(*pinctrl), GFP_KERNEL);
562 	if (!pinctrl)
564 	pinctrl->dev = &pdev->dev;
565 	platform_set_drvdata(pdev, pinctrl);
566 	spin_lock_init(&pinctrl->lock);
568 	pinctrl->base0 = devm_platform_ioremap_resource(pdev, 0);
569 	if (IS_ERR(pinctrl->base0))
570 		return PTR_ERR(pinctrl->base0);
575 	pinctrl->base1 = devm_ioremap(&pdev->dev, res->start,
577 	if (!pinctrl->base1) {
582 	pinctrl->base2 = devm_platform_ioremap_resource(pdev, 2);
583 	if (IS_ERR(pinctrl->base2))
584 		return PTR_ERR(pinctrl->base2);
586 	ret = nsp_mux_log_init(pinctrl);
603 	pinctrl->groups = nsp_pin_groups;
604 	pinctrl->num_groups = ARRAY_SIZE(nsp_pin_groups);
605 	pinctrl->functions = nsp_pin_functions;
606 	pinctrl->num_functions = ARRAY_SIZE(nsp_pin_functions);
609 	pinctrl->pctl = devm_pinctrl_register(&pdev->dev, &nsp_pinctrl_desc,
610 					 pinctrl);
611 	if (IS_ERR(pinctrl->pctl)) {
612 		dev_err(&pdev->dev, "unable to register nsp IOMUX pinctrl\n");
613 		return PTR_ERR(pinctrl->pctl);