mirror of
				https://github.com/smaeul/u-boot.git
				synced 2025-10-30 19:48:19 +00:00 
			
		
		
		
	As part of bringing the master branch back in to next, we need to allow for all of these changes to exist here. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
		
			
				
	
	
		
			71 lines
		
	
	
		
			1.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			71 lines
		
	
	
		
			1.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0+
 | |
| /*
 | |
|  * Copyright 2018-2019 NXP
 | |
|  */
 | |
| 
 | |
| #include <errno.h>
 | |
| #include <linux/bitops.h>
 | |
| #include <asm/io.h>
 | |
| #include <firmware/imx/sci/sci.h>
 | |
| #include <misc.h>
 | |
| 
 | |
| #include "pinctrl-imx.h"
 | |
| 
 | |
| #define PADRING_IFMUX_EN_SHIFT		31
 | |
| #define PADRING_IFMUX_EN_MASK		BIT(31)
 | |
| #define PADRING_GP_EN_SHIFT		30
 | |
| #define PADRING_GP_EN_MASK		BIT(30)
 | |
| #define PADRING_IFMUX_SHIFT		27
 | |
| #define PADRING_IFMUX_MASK		GENMASK(29, 27)
 | |
| 
 | |
| static int imx_pinconf_scu_set(struct imx_pinctrl_soc_info *info, u32 pad,
 | |
| 			       u32 mux, u32 val)
 | |
| {
 | |
| 	int ret;
 | |
| 
 | |
| 	/*
 | |
| 	 * Mux should be done in pmx set, but we do not have a good api
 | |
| 	 * to handle that in scfw, so config it in pad conf func
 | |
| 	 */
 | |
| 
 | |
| 	if (!sc_rm_is_pad_owned(-1, pad)) {
 | |
| 		debug("Pad[%u] is not owned by curr partition\n", pad);
 | |
| 		return -EPERM;
 | |
| 	}
 | |
| 
 | |
| 	val |= PADRING_IFMUX_EN_MASK;
 | |
| 	val |= PADRING_GP_EN_MASK;
 | |
| 	val |= (mux << PADRING_IFMUX_SHIFT) & PADRING_IFMUX_MASK;
 | |
| 
 | |
| 	ret = sc_pad_set(-1, pad, val);
 | |
| 	if (ret)
 | |
| 		printf("%s %d\n", __func__, ret);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int imx_pinctrl_scu_conf_pins(struct imx_pinctrl_soc_info *info, u32 *pin_data,
 | |
| 			      int npins)
 | |
| {
 | |
| 	int pin_id, mux, config_val;
 | |
| 	int i, j = 0;
 | |
| 	int ret;
 | |
| 
 | |
| 	/*
 | |
| 	 * Refer to linux documentation for details:
 | |
| 	 * Documentation/devicetree/bindings/pinctrl/fsl,imx-pinctrl.txt
 | |
| 	 */
 | |
| 	for (i = 0; i < npins; i++) {
 | |
| 		pin_id = pin_data[j++];
 | |
| 		mux = pin_data[j++];
 | |
| 		config_val = pin_data[j++];
 | |
| 
 | |
| 		ret = imx_pinconf_scu_set(info, pin_id, mux, config_val);
 | |
| 		if (ret && ret != -EPERM)
 | |
| 			printf("Set pin %d, mux %d, val %d, error\n", pin_id,
 | |
| 			       mux, config_val);
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 |