pinctrl/bcm/pinctrl-cygnus-mux.c

20 #include <linux/pinctrl/pinconf-generic.h>
21 #include <linux/pinctrl/pinconf.h>
22 #include <linux/pinctrl/pinctrl.h>
23 #include <linux/pinctrl/pinmux.h>
26 #include "../pinctrl-utils.h"
87  * Cygnus IOMUX pinctrl core
700 	struct cygnus_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
702 	return pinctrl->num_groups;
708 	struct cygnus_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
710 	return pinctrl->groups[selector].name;
717 	struct cygnus_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
719 	*pins = pinctrl->groups[selector].pins;
720 	*num_pins = pinctrl->groups[selector].num_pins;
742 	struct cygnus_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
744 	return pinctrl->num_functions;
750 	struct cygnus_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
752 	return pinctrl->functions[selector].name;
760 	struct cygnus_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
762 	*groups = pinctrl->functions[selector].groups;
763 	*num_groups = pinctrl->functions[selector].num_groups;
768 static int cygnus_pinmux_set(struct cygnus_pinctrl *pinctrl,
794 			dev_err(pinctrl->dev,
796 			dev_err(pinctrl->dev, "func:%s grp:%s\n",
811 	spin_lock_irqsave(&pinctrl->lock, flags);
813 	val = readl(pinctrl->base0 + grp->mux.offset);
816 	writel(val, pinctrl->base0 + grp->mux.offset);
818 	spin_unlock_irqrestore(&pinctrl->lock, flags);
826 	struct cygnus_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
828 		&pinctrl->functions[func_select];
829 	const struct cygnus_pin_group *grp = &pinctrl->groups[grp_select];
837 	return cygnus_pinmux_set(pinctrl, func, grp, pinctrl->mux_log);
844 	struct cygnus_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
853 	spin_lock_irqsave(&pinctrl->lock, flags);
855 	val = readl(pinctrl->base1 + mux->offset);
857 	writel(val, pinctrl->base1 + mux->offset);
859 	spin_unlock_irqrestore(&pinctrl->lock, flags);
872 	struct cygnus_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
880 	spin_lock_irqsave(&pinctrl->lock, flags);
882 	val = readl(pinctrl->base1 + mux->offset);
884 	writel(val, pinctrl->base1 + mux->offset);
886 	spin_unlock_irqrestore(&pinctrl->lock, flags);
909 static int cygnus_mux_log_init(struct cygnus_pinctrl *pinctrl)
914 	pinctrl->mux_log = devm_kcalloc(pinctrl->dev, CYGNUS_NUM_IOMUX,
917 	if (!pinctrl->mux_log)
922 			log = &pinctrl->mux_log[i * CYGNUS_NUM_MUX_PER_REG
936 	struct cygnus_pinctrl *pinctrl;
940 	pinctrl = devm_kzalloc(&pdev->dev, sizeof(*pinctrl), GFP_KERNEL);
941 	if (!pinctrl)
944 	pinctrl->dev = &pdev->dev;
945 	platform_set_drvdata(pdev, pinctrl);
946 	spin_lock_init(&pinctrl->lock);
948 	pinctrl->base0 = devm_platform_ioremap_resource(pdev, 0);
949 	if (IS_ERR(pinctrl->base0)) {
951 		return PTR_ERR(pinctrl->base0);
954 	pinctrl->base1 = devm_platform_ioremap_resource(pdev, 1);
955 	if (IS_ERR(pinctrl->base1)) {
957 		return PTR_ERR(pinctrl->base1);
960 	ret = cygnus_mux_log_init(pinctrl);
977 	pinctrl->groups = cygnus_pin_groups;
978 	pinctrl->num_groups = ARRAY_SIZE(cygnus_pin_groups);
979 	pinctrl->functions = cygnus_pin_functions;
980 	pinctrl->num_functions = ARRAY_SIZE(cygnus_pin_functions);
983 	pinctrl->pctl = devm_pinctrl_register(&pdev->dev, &cygnus_pinctrl_desc,
984 			pinctrl);
985 	if (IS_ERR(pinctrl->pctl)) {
986 		dev_err(&pdev->dev, "unable to register Cygnus IOMUX pinctrl\n");
987 		return PTR_ERR(pinctrl->pctl);