ramips: 5.10: copy patches from 5.4
Strict copy, no changes made. Signed-off-by: Ilya Lipnitskiy <ilya.lipnitskiy@gmail.com>
This commit is contained in:
		 Ilya Lipnitskiy
					Ilya Lipnitskiy
				
			
				
					committed by
					
						 Adrian Schmutzler
						Adrian Schmutzler
					
				
			
			
				
	
			
			
			 Adrian Schmutzler
						Adrian Schmutzler
					
				
			
						parent
						
							a9966793e8
						
					
				
				
					commit
					eda836e390
				
			| @@ -0,0 +1,192 @@ | ||||
| From: Paul Burton <paul.burton@mips.com> | ||||
| Date: Wed, 9 Oct 2019 23:09:45 +0000 | ||||
| Subject: MIPS: cmdline: Clean up boot_command_line initialization | ||||
|  | ||||
| Our current code to initialize boot_command_line is a mess. Some of this | ||||
| is due to the addition of too many options over the years, and some of | ||||
| this is due to workarounds for early_init_dt_scan_chosen() performing | ||||
| actions specific to options from other architectures that probably | ||||
| shouldn't be in generic code. | ||||
|  | ||||
| Clean this up by introducing a new bootcmdline_init() function that | ||||
| simplifies the initialization somewhat. The major changes are: | ||||
|  | ||||
| - Because bootcmdline_init() is a function it can return early in the | ||||
|   CONFIG_CMDLINE_OVERRIDE case. | ||||
|  | ||||
| - We clear boot_command_line rather than inheriting whatever | ||||
|   early_init_dt_scan_chosen() may have left us. This means we no longer | ||||
|   need to set boot_command_line to a space character in an attempt to | ||||
|   prevent early_init_dt_scan_chosen() from copying CONFIG_CMDLINE into | ||||
|   boot_command_line without us knowing about it. | ||||
|  | ||||
| - Indirection via USE_PROM_CMDLINE, USE_DTB_CMDLINE, EXTEND_WITH_PROM & | ||||
|   BUILTIN_EXTEND_WITH_PROM macros is removed; they seemingly served only | ||||
|   to obfuscate the code. | ||||
|  | ||||
| - The logic is cleaner, clearer & commented. | ||||
|  | ||||
| Two minor drawbacks of this approach are: | ||||
|  | ||||
| 1) We call of_scan_flat_dt(), which means we scan through the DT again. | ||||
|    The overhead is fairly minimal & shouldn't be noticeable. | ||||
|  | ||||
| 2) cmdline_scan_chosen() duplicates a small amount of the logic from | ||||
|    early_init_dt_scan_chosen(). Alternatives might be to allow the | ||||
|    generic FDT code to keep & expose a copy of the arguments taken from | ||||
|    the /chosen node's bootargs property, or to introduce a function like | ||||
|    early_init_dt_scan_chosen() that retrieves them without modification | ||||
|    to handle CONFIG_CMDLINE. Neither of these sounds particularly | ||||
|    cleaner though, and this way we at least keep the extra work in | ||||
|    arch/mips. | ||||
|  | ||||
| Origin: upstream, https://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git/commit/?id=7784cac697351f0cc0a4bb619594c0c99348c5aa | ||||
| Signed-off-by: Paul Burton <paul.burton@mips.com> | ||||
| Cc: linux-mips@vger.kernel.org | ||||
|  | ||||
| --- a/arch/mips/kernel/setup.c | ||||
| +++ b/arch/mips/kernel/setup.c | ||||
| @@ -538,11 +538,88 @@ static void __init check_kernel_sections | ||||
|  	} | ||||
|  } | ||||
|   | ||||
| -#define USE_PROM_CMDLINE	IS_ENABLED(CONFIG_MIPS_CMDLINE_FROM_BOOTLOADER) | ||||
| -#define USE_DTB_CMDLINE		IS_ENABLED(CONFIG_MIPS_CMDLINE_FROM_DTB) | ||||
| -#define EXTEND_WITH_PROM	IS_ENABLED(CONFIG_MIPS_CMDLINE_DTB_EXTEND) | ||||
| -#define BUILTIN_EXTEND_WITH_PROM	\ | ||||
| -	IS_ENABLED(CONFIG_MIPS_CMDLINE_BUILTIN_EXTEND) | ||||
| +static void __init bootcmdline_append(const char *s, size_t max) | ||||
| +{ | ||||
| +	if (!s[0] || !max) | ||||
| +		return; | ||||
| + | ||||
| +	if (boot_command_line[0]) | ||||
| +		strlcat(boot_command_line, " ", COMMAND_LINE_SIZE); | ||||
| + | ||||
| +	strlcat(boot_command_line, s, max); | ||||
| +} | ||||
| + | ||||
| +static int __init bootcmdline_scan_chosen(unsigned long node, const char *uname, | ||||
| +					  int depth, void *data) | ||||
| +{ | ||||
| +	bool *dt_bootargs = data; | ||||
| +	const char *p; | ||||
| +	int l; | ||||
| + | ||||
| +	if (depth != 1 || !data || | ||||
| +	    (strcmp(uname, "chosen") != 0 && strcmp(uname, "chosen@0") != 0)) | ||||
| +		return 0; | ||||
| + | ||||
| +	p = of_get_flat_dt_prop(node, "bootargs", &l); | ||||
| +	if (p != NULL && l > 0) { | ||||
| +		bootcmdline_append(p, min(l, COMMAND_LINE_SIZE)); | ||||
| +		*dt_bootargs = true; | ||||
| +	} | ||||
| + | ||||
| +	return 1; | ||||
| +} | ||||
| + | ||||
| +static void __init bootcmdline_init(char **cmdline_p) | ||||
| +{ | ||||
| +	bool dt_bootargs = false; | ||||
| + | ||||
| +	/* | ||||
| +	 * If CMDLINE_OVERRIDE is enabled then initializing the command line is | ||||
| +	 * trivial - we simply use the built-in command line unconditionally & | ||||
| +	 * unmodified. | ||||
| +	 */ | ||||
| +	if (IS_ENABLED(CONFIG_CMDLINE_OVERRIDE)) { | ||||
| +		strlcpy(boot_command_line, builtin_cmdline, COMMAND_LINE_SIZE); | ||||
| +		return; | ||||
| +	} | ||||
| + | ||||
| +	/* | ||||
| +	 * If the user specified a built-in command line & | ||||
| +	 * MIPS_CMDLINE_BUILTIN_EXTEND, then the built-in command line is | ||||
| +	 * prepended to arguments from the bootloader or DT so we'll copy them | ||||
| +	 * to the start of boot_command_line here. Otherwise, empty | ||||
| +	 * boot_command_line to undo anything early_init_dt_scan_chosen() did. | ||||
| +	 */ | ||||
| +	if (IS_ENABLED(CONFIG_MIPS_CMDLINE_BUILTIN_EXTEND)) | ||||
| +		strlcpy(boot_command_line, builtin_cmdline, COMMAND_LINE_SIZE); | ||||
| +	else | ||||
| +		boot_command_line[0] = 0; | ||||
| + | ||||
| +	/* | ||||
| +	 * If we're configured to take boot arguments from DT, look for those | ||||
| +	 * now. | ||||
| +	 */ | ||||
| +	if (IS_ENABLED(CONFIG_MIPS_CMDLINE_FROM_DTB)) | ||||
| +		of_scan_flat_dt(bootcmdline_scan_chosen, &dt_bootargs); | ||||
| + | ||||
| +	/* | ||||
| +	 * If we didn't get any arguments from DT (regardless of whether that's | ||||
| +	 * because we weren't configured to look for them, or because we looked | ||||
| +	 * & found none) then we'll take arguments from the bootloader. | ||||
| +	 * plat_mem_setup() should have filled arcs_cmdline with arguments from | ||||
| +	 * the bootloader. | ||||
| +	 */ | ||||
| +	if (IS_ENABLED(CONFIG_MIPS_CMDLINE_DTB_EXTEND) || !dt_bootargs) | ||||
| +		bootcmdline_append(arcs_cmdline, COMMAND_LINE_SIZE); | ||||
| + | ||||
| +	/* | ||||
| +	 * If the user specified a built-in command line & we didn't already | ||||
| +	 * prepend it, we append it to boot_command_line here. | ||||
| +	 */ | ||||
| +	if (IS_ENABLED(CONFIG_CMDLINE_BOOL) && | ||||
| +	    !IS_ENABLED(CONFIG_MIPS_CMDLINE_BUILTIN_EXTEND)) | ||||
| +		bootcmdline_append(builtin_cmdline, COMMAND_LINE_SIZE); | ||||
| +} | ||||
|   | ||||
|  /* | ||||
|   * arch_mem_init - initialize memory management subsystem | ||||
| @@ -570,48 +647,12 @@ static void __init arch_mem_init(char ** | ||||
|  { | ||||
|  	extern void plat_mem_setup(void); | ||||
|   | ||||
| -	/* | ||||
| -	 * Initialize boot_command_line to an innocuous but non-empty string in | ||||
| -	 * order to prevent early_init_dt_scan_chosen() from copying | ||||
| -	 * CONFIG_CMDLINE into it without our knowledge. We handle | ||||
| -	 * CONFIG_CMDLINE ourselves below & don't want to duplicate its | ||||
| -	 * content because repeating arguments can be problematic. | ||||
| -	 */ | ||||
| -	strlcpy(boot_command_line, " ", COMMAND_LINE_SIZE); | ||||
| - | ||||
|  	/* call board setup routine */ | ||||
|  	plat_mem_setup(); | ||||
|  	memblock_set_bottom_up(true); | ||||
|   | ||||
| -#if defined(CONFIG_CMDLINE_BOOL) && defined(CONFIG_CMDLINE_OVERRIDE) | ||||
| -	strlcpy(boot_command_line, builtin_cmdline, COMMAND_LINE_SIZE); | ||||
| -#else | ||||
| -	if ((USE_PROM_CMDLINE && arcs_cmdline[0]) || | ||||
| -	    (USE_DTB_CMDLINE && !boot_command_line[0])) | ||||
| -		strlcpy(boot_command_line, arcs_cmdline, COMMAND_LINE_SIZE); | ||||
| - | ||||
| -	if (EXTEND_WITH_PROM && arcs_cmdline[0]) { | ||||
| -		if (boot_command_line[0]) | ||||
| -			strlcat(boot_command_line, " ", COMMAND_LINE_SIZE); | ||||
| -		strlcat(boot_command_line, arcs_cmdline, COMMAND_LINE_SIZE); | ||||
| -	} | ||||
| - | ||||
| -#if defined(CONFIG_CMDLINE_BOOL) | ||||
| -	if (builtin_cmdline[0]) { | ||||
| -		if (boot_command_line[0]) | ||||
| -			strlcat(boot_command_line, " ", COMMAND_LINE_SIZE); | ||||
| -		strlcat(boot_command_line, builtin_cmdline, COMMAND_LINE_SIZE); | ||||
| -	} | ||||
| - | ||||
| -	if (BUILTIN_EXTEND_WITH_PROM && arcs_cmdline[0]) { | ||||
| -		if (boot_command_line[0]) | ||||
| -			strlcat(boot_command_line, " ", COMMAND_LINE_SIZE); | ||||
| -		strlcat(boot_command_line, arcs_cmdline, COMMAND_LINE_SIZE); | ||||
| -	} | ||||
| -#endif | ||||
| -#endif | ||||
| +	bootcmdline_init(cmdline_p); | ||||
|  	strlcpy(command_line, boot_command_line, COMMAND_LINE_SIZE); | ||||
| - | ||||
|  	*cmdline_p = command_line; | ||||
|   | ||||
|  	parse_early_param(); | ||||
| @@ -0,0 +1,44 @@ | ||||
| From b7340422cc16c5deff100812f38114bb5ec81203 Mon Sep 17 00:00:00 2001 | ||||
| From: Paul Burton <paul.burton@mips.com> | ||||
| Date: Sat, 12 Oct 2019 20:43:36 +0000 | ||||
| Subject: [PATCH] MIPS: Always define builtin_cmdline | ||||
|  | ||||
| Commit 7784cac69735 ("MIPS: cmdline: Clean up boot_command_line | ||||
| initialization") made use of builtin_cmdline conditional upon plain C if | ||||
| statements rather than preprocessor #ifdef's. This caused build failures | ||||
| for configurations with CONFIG_CMDLINE_BOOL=n where builtin_cmdline | ||||
| wasn't defined, for example: | ||||
|  | ||||
|    arch/mips/kernel/setup.c: In function 'bootcmdline_init': | ||||
| >> arch/mips/kernel/setup.c:582:30: error: 'builtin_cmdline' undeclared | ||||
|     (first use in this function); did you mean 'builtin_driver'? | ||||
|       strlcpy(boot_command_line, builtin_cmdline, COMMAND_LINE_SIZE); | ||||
|                                  ^~~~~~~~~~~~~~~ | ||||
|                                  builtin_driver | ||||
|    arch/mips/kernel/setup.c:582:30: note: each undeclared identifier is | ||||
|     reported only once for each function it appears in | ||||
|  | ||||
| Fix this by defining builtin_cmdline as an empty string in the affected | ||||
| configurations. All of the paths that use it should be optimized out | ||||
| anyway so the data itself gets optimized away too. | ||||
|  | ||||
| Signed-off-by: Paul Burton <paul.burton@mips.com> | ||||
| Fixes: 7784cac69735 ("MIPS: cmdline: Clean up boot_command_line initialization") | ||||
| Reported-by: kbuild test robot <lkp@intel.com> | ||||
| Reported-by: Nathan Chancellor <natechancellor@gmail.com> | ||||
| Cc: linux-mips@vger.kernel.org | ||||
| --- | ||||
|  arch/mips/kernel/setup.c | 2 ++ | ||||
|  1 file changed, 2 insertions(+) | ||||
|  | ||||
| --- a/arch/mips/kernel/setup.c | ||||
| +++ b/arch/mips/kernel/setup.c | ||||
| @@ -68,6 +68,8 @@ char __initdata arcs_cmdline[COMMAND_LIN | ||||
|   | ||||
|  #ifdef CONFIG_CMDLINE_BOOL | ||||
|  static char __initdata builtin_cmdline[COMMAND_LINE_SIZE] = CONFIG_CMDLINE; | ||||
| +#else | ||||
| +static const char builtin_cmdline[] __initconst = ""; | ||||
|  #endif | ||||
|   | ||||
|  /* | ||||
| @@ -0,0 +1,45 @@ | ||||
| From: Tobias Wolf <dev-NTEO@vplace.de> | ||||
| Subject: [v2] MIPS: Fix memory reservation in bootmem_init for certain non-usermem setups | ||||
|  | ||||
| Commit 67a3ba25aa95 ("MIPS: Fix incorrect mem=X@Y handling") introduced a new | ||||
| issue for rt288x where "PHYS_OFFSET" is 0x0 but the calculated "ramstart" is | ||||
| not. As the prerequisite of custom memory map has been removed, this results | ||||
| in the full memory range of 0x0 - 0x8000000 to be marked as reserved for this | ||||
| platform. | ||||
|  | ||||
| v2: Correctly compare that usermem is not null. | ||||
|  | ||||
| This patch adds the originally intended prerequisite again. | ||||
|  | ||||
| Signed-off-by: Tobias Wolf <dev-NTEO@vplace.de> | ||||
| --- | ||||
|  | ||||
| --- a/arch/mips/kernel/setup.c | ||||
| +++ b/arch/mips/kernel/setup.c | ||||
| @@ -287,6 +287,8 @@ static unsigned long __init init_initrd( | ||||
|   * Initialize the bootmem allocator. It also setup initrd related data | ||||
|   * if needed. | ||||
|   */ | ||||
| +static int usermem __initdata; | ||||
| + | ||||
|  #if defined(CONFIG_SGI_IP27) || (defined(CONFIG_CPU_LOONGSON3) && defined(CONFIG_NUMA)) | ||||
|   | ||||
|  static void __init bootmem_init(void) | ||||
| @@ -325,7 +327,7 @@ static void __init bootmem_init(void) | ||||
|  	/* | ||||
|  	 * Reserve any memory between the start of RAM and PHYS_OFFSET | ||||
|  	 */ | ||||
| -	if (ramstart > PHYS_OFFSET) | ||||
| +	if (usermem && ramstart > PHYS_OFFSET) | ||||
|  		memblock_reserve(PHYS_OFFSET, ramstart - PHYS_OFFSET); | ||||
|   | ||||
|  	if (PFN_UP(ramstart) > ARCH_PFN_OFFSET) { | ||||
| @@ -386,8 +388,6 @@ static void __init bootmem_init(void) | ||||
|   | ||||
|  #endif	/* CONFIG_SGI_IP27 */ | ||||
|   | ||||
| -static int usermem __initdata; | ||||
| - | ||||
|  static int __init early_parse_mem(char *p) | ||||
|  { | ||||
|  	phys_addr_t start, size; | ||||
| @@ -0,0 +1,82 @@ | ||||
| From ce3d4a4111a5f7e6b4e74bceae5faa6ce388e8ec Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Sun, 14 Jul 2013 23:08:11 +0200 | ||||
| Subject: [PATCH 05/53] MIPS: use set_mode() to enable/disable the cevt-r4k | ||||
|  irq | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  arch/mips/ralink/Kconfig |    5 +++++ | ||||
|  1 file changed, 5 insertions(+) | ||||
|  | ||||
| --- a/arch/mips/ralink/Kconfig | ||||
| +++ b/arch/mips/ralink/Kconfig | ||||
| @@ -1,12 +1,17 @@ | ||||
|  # SPDX-License-Identifier: GPL-2.0 | ||||
|  if RALINK | ||||
|   | ||||
| +config CEVT_SYSTICK_QUIRK | ||||
| +	bool | ||||
| +	default n | ||||
| + | ||||
|  config CLKEVT_RT3352 | ||||
|  	bool | ||||
|  	depends on SOC_RT305X || SOC_MT7620 | ||||
|  	default y | ||||
|  	select TIMER_OF | ||||
|  	select CLKSRC_MMIO | ||||
| +	select CEVT_SYSTICK_QUIRK | ||||
|   | ||||
|  config RALINK_ILL_ACC | ||||
|  	bool | ||||
| --- a/arch/mips/kernel/cevt-r4k.c | ||||
| +++ b/arch/mips/kernel/cevt-r4k.c | ||||
| @@ -15,6 +15,26 @@ | ||||
|  #include <asm/time.h> | ||||
|  #include <asm/cevt-r4k.h> | ||||
|   | ||||
| +static int mips_state_oneshot(struct clock_event_device *evt) | ||||
| +{ | ||||
| +	if (!cp0_timer_irq_installed) { | ||||
| +		cp0_timer_irq_installed = 1; | ||||
| +		setup_irq(evt->irq, &c0_compare_irqaction); | ||||
| +	} | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static int mips_state_shutdown(struct clock_event_device *evt) | ||||
| +{ | ||||
| +	if (cp0_timer_irq_installed) { | ||||
| +		cp0_timer_irq_installed = 0; | ||||
| +		remove_irq(evt->irq, &c0_compare_irqaction); | ||||
| +	} | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
|  static int mips_next_event(unsigned long delta, | ||||
|  			   struct clock_event_device *evt) | ||||
|  { | ||||
| @@ -281,17 +301,21 @@ int r4k_clockevent_init(void) | ||||
|  	cd->rating		= 300; | ||||
|  	cd->irq			= irq; | ||||
|  	cd->cpumask		= cpumask_of(cpu); | ||||
| +	cd->set_state_shutdown	= mips_state_shutdown; | ||||
| +	cd->set_state_oneshot	= mips_state_oneshot; | ||||
|  	cd->set_next_event	= mips_next_event; | ||||
|  	cd->event_handler	= mips_event_handler; | ||||
|   | ||||
|  	clockevents_config_and_register(cd, mips_hpt_frequency, min_delta, 0x7fffffff); | ||||
|   | ||||
| +#ifndef CONFIG_CEVT_SYSTICK_QUIRK | ||||
|  	if (cp0_timer_irq_installed) | ||||
|  		return 0; | ||||
|   | ||||
|  	cp0_timer_irq_installed = 1; | ||||
|   | ||||
|  	setup_irq(irq, &c0_compare_irqaction); | ||||
| +#endif | ||||
|   | ||||
|  	return 0; | ||||
|  } | ||||
| @@ -0,0 +1,200 @@ | ||||
| From bd30f19a006fb52bac80c6463c49dd2f4159f4ac Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Sun, 28 Jul 2013 16:26:41 +0200 | ||||
| Subject: [PATCH 06/53] MIPS: ralink: add cpu frequency scaling | ||||
|  | ||||
| This feature will break udelay() and cause the delay loop to have longer delays | ||||
| when the frequency is scaled causing a performance hit. | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  arch/mips/ralink/cevt-rt3352.c |   38 ++++++++++++++++++++++++++++++++++++++ | ||||
|  1 file changed, 38 insertions(+) | ||||
|  | ||||
| --- a/arch/mips/ralink/cevt-rt3352.c | ||||
| +++ b/arch/mips/ralink/cevt-rt3352.c | ||||
| @@ -29,6 +29,10 @@ | ||||
|  /* enable the counter */ | ||||
|  #define CFG_CNT_EN		0x1 | ||||
|   | ||||
| +/* mt7620 frequency scaling defines */ | ||||
| +#define CLK_LUT_CFG	0x40 | ||||
| +#define SLEEP_EN	BIT(31) | ||||
| + | ||||
|  struct systick_device { | ||||
|  	void __iomem *membase; | ||||
|  	struct clock_event_device dev; | ||||
| @@ -36,21 +40,53 @@ struct systick_device { | ||||
|  	int freq_scale; | ||||
|  }; | ||||
|   | ||||
| +static void (*systick_freq_scaling)(struct systick_device *sdev, int status); | ||||
| + | ||||
|  static int systick_set_oneshot(struct clock_event_device *evt); | ||||
|  static int systick_shutdown(struct clock_event_device *evt); | ||||
|   | ||||
| +static inline void mt7620_freq_scaling(struct systick_device *sdev, int status) | ||||
| +{ | ||||
| +	if (sdev->freq_scale == status) | ||||
| +		return; | ||||
| + | ||||
| +	sdev->freq_scale = status; | ||||
| + | ||||
| +	pr_info("%s: %s autosleep mode\n", sdev->dev.name, | ||||
| +			(status) ? ("enable") : ("disable")); | ||||
| +	if (status) | ||||
| +		rt_sysc_w32(rt_sysc_r32(CLK_LUT_CFG) | SLEEP_EN, CLK_LUT_CFG); | ||||
| +	else | ||||
| +		rt_sysc_w32(rt_sysc_r32(CLK_LUT_CFG) & ~SLEEP_EN, CLK_LUT_CFG); | ||||
| +} | ||||
| + | ||||
| +static inline unsigned int read_count(struct systick_device *sdev) | ||||
| +{ | ||||
| +	return ioread32(sdev->membase + SYSTICK_COUNT); | ||||
| +} | ||||
| + | ||||
| +static inline unsigned int read_compare(struct systick_device *sdev) | ||||
| +{ | ||||
| +	return ioread32(sdev->membase + SYSTICK_COMPARE); | ||||
| +} | ||||
| + | ||||
| +static inline void write_compare(struct systick_device *sdev, unsigned int val) | ||||
| +{ | ||||
| +	iowrite32(val, sdev->membase + SYSTICK_COMPARE); | ||||
| +} | ||||
| + | ||||
|  static int systick_next_event(unsigned long delta, | ||||
|  				struct clock_event_device *evt) | ||||
|  { | ||||
|  	struct systick_device *sdev; | ||||
| -	u32 count; | ||||
| +	int res; | ||||
|   | ||||
|  	sdev = container_of(evt, struct systick_device, dev); | ||||
| -	count = ioread32(sdev->membase + SYSTICK_COUNT); | ||||
| -	count = (count + delta) % SYSTICK_FREQ; | ||||
| -	iowrite32(count, sdev->membase + SYSTICK_COMPARE); | ||||
| +	delta += read_count(sdev); | ||||
| +	write_compare(sdev, delta); | ||||
| +	res = ((int)(read_count(sdev) - delta) >= 0) ? -ETIME : 0; | ||||
|   | ||||
| -	return 0; | ||||
| +	return res; | ||||
|  } | ||||
|   | ||||
|  static void systick_event_handler(struct clock_event_device *dev) | ||||
| @@ -60,20 +96,25 @@ static void systick_event_handler(struct | ||||
|   | ||||
|  static irqreturn_t systick_interrupt(int irq, void *dev_id) | ||||
|  { | ||||
| -	struct clock_event_device *dev = (struct clock_event_device *) dev_id; | ||||
| +	int ret = 0; | ||||
| +	struct clock_event_device *cdev; | ||||
| +	struct systick_device *sdev; | ||||
|   | ||||
| -	dev->event_handler(dev); | ||||
| +	if (read_c0_cause() & STATUSF_IP7) { | ||||
| +		cdev = (struct clock_event_device *) dev_id; | ||||
| +		sdev = container_of(cdev, struct systick_device, dev); | ||||
| + | ||||
| +		/* Clear Count/Compare Interrupt */ | ||||
| +		write_compare(sdev, read_compare(sdev)); | ||||
| +		cdev->event_handler(cdev); | ||||
| +		ret = 1; | ||||
| +	} | ||||
|   | ||||
| -	return IRQ_HANDLED; | ||||
| +	return IRQ_RETVAL(ret); | ||||
|  } | ||||
|   | ||||
|  static struct systick_device systick = { | ||||
|  	.dev = { | ||||
| -		/* | ||||
| -		 * cevt-r4k uses 300, make sure systick | ||||
| -		 * gets used if available | ||||
| -		 */ | ||||
| -		.rating			= 310, | ||||
|  		.features		= CLOCK_EVT_FEAT_ONESHOT, | ||||
|  		.set_next_event		= systick_next_event, | ||||
|  		.set_state_shutdown	= systick_shutdown, | ||||
| @@ -95,9 +136,15 @@ static int systick_shutdown(struct clock | ||||
|  	sdev = container_of(evt, struct systick_device, dev); | ||||
|   | ||||
|  	if (sdev->irq_requested) | ||||
| -		free_irq(systick.dev.irq, &systick_irqaction); | ||||
| +		remove_irq(systick.dev.irq, &systick_irqaction); | ||||
|  	sdev->irq_requested = 0; | ||||
| -	iowrite32(0, systick.membase + SYSTICK_CONFIG); | ||||
| +	iowrite32(CFG_CNT_EN, systick.membase + SYSTICK_CONFIG); | ||||
| + | ||||
| +	if (systick_freq_scaling) | ||||
| +		systick_freq_scaling(sdev, 0); | ||||
| + | ||||
| +	if (systick_freq_scaling) | ||||
| +		systick_freq_scaling(sdev, 1); | ||||
|   | ||||
|  	return 0; | ||||
|  } | ||||
| @@ -117,34 +164,48 @@ static int systick_set_oneshot(struct cl | ||||
|  	return 0; | ||||
|  } | ||||
|   | ||||
| +static const struct of_device_id systick_match[] = { | ||||
| +	{ .compatible = "ralink,mt7620a-systick", .data = mt7620_freq_scaling}, | ||||
| +	{}, | ||||
| +}; | ||||
| + | ||||
|  static int __init ralink_systick_init(struct device_node *np) | ||||
|  { | ||||
| +	const struct of_device_id *match; | ||||
| +	int rating = 200; | ||||
|  	int ret; | ||||
|   | ||||
|  	systick.membase = of_iomap(np, 0); | ||||
|  	if (!systick.membase) | ||||
|  		return -ENXIO; | ||||
|   | ||||
| -	systick_irqaction.name = np->name; | ||||
| -	systick.dev.name = np->name; | ||||
| -	clockevents_calc_mult_shift(&systick.dev, SYSTICK_FREQ, 60); | ||||
| -	systick.dev.max_delta_ns = clockevent_delta2ns(0x7fff, &systick.dev); | ||||
| -	systick.dev.max_delta_ticks = 0x7fff; | ||||
| -	systick.dev.min_delta_ns = clockevent_delta2ns(0x3, &systick.dev); | ||||
| -	systick.dev.min_delta_ticks = 0x3; | ||||
| +	match = of_match_node(systick_match, np); | ||||
| +	if (match) { | ||||
| +		systick_freq_scaling = match->data; | ||||
| +		/* | ||||
| +		 * cevt-r4k uses 300, make sure systick | ||||
| +		 * gets used if available | ||||
| +		 */ | ||||
| +		rating = 310; | ||||
| +	} | ||||
| + | ||||
| +	/* enable counter than register clock source */ | ||||
| +	iowrite32(CFG_CNT_EN, systick.membase + SYSTICK_CONFIG); | ||||
| +	clocksource_mmio_init(systick.membase + SYSTICK_COUNT, np->name, | ||||
| +			SYSTICK_FREQ, rating, 16, clocksource_mmio_readl_up); | ||||
| + | ||||
| +	/* register clock event */ | ||||
|  	systick.dev.irq = irq_of_parse_and_map(np, 0); | ||||
|  	if (!systick.dev.irq) { | ||||
|  		pr_err("%pOFn: request_irq failed", np); | ||||
|  		return -EINVAL; | ||||
|  	} | ||||
|   | ||||
| -	ret = clocksource_mmio_init(systick.membase + SYSTICK_COUNT, np->name, | ||||
| -				    SYSTICK_FREQ, 301, 16, | ||||
| -				    clocksource_mmio_readl_up); | ||||
| -	if (ret) | ||||
| -		return ret; | ||||
| - | ||||
| -	clockevents_register_device(&systick.dev); | ||||
| +	systick_irqaction.name = np->name; | ||||
| +	systick.dev.name = np->name; | ||||
| +	systick.dev.rating = rating; | ||||
| +	systick.dev.cpumask = cpumask_of(0); | ||||
| +	clockevents_config_and_register(&systick.dev, SYSTICK_FREQ, 0x3, 0x7fff); | ||||
|   | ||||
|  	pr_info("%pOFn: running - mult: %d, shift: %d\n", | ||||
|  			np, systick.dev.mult, systick.dev.shift); | ||||
| @@ -0,0 +1,21 @@ | ||||
| From 67b7bff0fd364c194e653f69baa623ba2141bd4c Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Mon, 4 Aug 2014 18:46:02 +0200 | ||||
| Subject: [PATCH 07/53] MIPS: ralink: copy the commandline from the devicetree | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  arch/mips/ralink/of.c |    2 ++ | ||||
|  1 file changed, 2 insertions(+) | ||||
|  | ||||
| --- a/arch/mips/ralink/of.c | ||||
| +++ b/arch/mips/ralink/of.c | ||||
| @@ -80,6 +80,8 @@ void __init plat_mem_setup(void) | ||||
|   | ||||
|  	__dt_setup_arch(dtb); | ||||
|   | ||||
| +	strlcpy(arcs_cmdline, boot_command_line, COMMAND_LINE_SIZE); | ||||
| + | ||||
|  	of_scan_flat_dt(early_init_dt_find_memory, NULL); | ||||
|  	if (memory_dtb) | ||||
|  		of_scan_flat_dt(early_init_dt_scan_memory, NULL); | ||||
| @@ -0,0 +1,63 @@ | ||||
| From f15d27f9c90ede4b16eb37f9ae573ef81c2b6996 Mon Sep 17 00:00:00 2001 | ||||
| From: David Bauer <mail@david-bauer.net> | ||||
| Date: Thu, 31 Dec 2020 18:49:12 +0100 | ||||
| Subject: [PATCH] MIPS: add bootargs-override property | ||||
|  | ||||
| Add support for the bootargs-override property to the chosen node | ||||
| similar to the one used on ipq806x or mpc85xx. | ||||
|  | ||||
| This is necessary, as the U-Boot used on some boards, notably the | ||||
| Ubiquiti UniFi 6 Lite, overwrite the bootargs property of the chosen | ||||
| node leading to a kernel panic when loading OpenWrt. | ||||
|  | ||||
| Signed-off-by: David Bauer <mail@david-bauer.net> | ||||
| --- | ||||
|  arch/mips/kernel/setup.c | 30 ++++++++++++++++++++++++++++++ | ||||
|  1 file changed, 30 insertions(+) | ||||
|  | ||||
| --- a/arch/mips/kernel/setup.c | ||||
| +++ b/arch/mips/kernel/setup.c | ||||
| @@ -571,8 +571,28 @@ static int __init bootcmdline_scan_chose | ||||
|  	return 1; | ||||
|  } | ||||
|   | ||||
| +static int __init bootcmdline_scan_chosen_override(unsigned long node, const char *uname, | ||||
| +						   int depth, void *data) | ||||
| +{ | ||||
| +	bool *dt_bootargs = data; | ||||
| +	const char *p; | ||||
| +	int l; | ||||
| + | ||||
| +	if (depth != 1 || !data || strcmp(uname, "chosen") != 0) | ||||
| +		return 0; | ||||
| + | ||||
| +	p = of_get_flat_dt_prop(node, "bootargs-override", &l); | ||||
| +	if (p != NULL && l > 0) { | ||||
| +		strlcpy(boot_command_line, p, COMMAND_LINE_SIZE); | ||||
| +		*dt_bootargs = true; | ||||
| +	} | ||||
| + | ||||
| +	return 1; | ||||
| +} | ||||
| + | ||||
|  static void __init bootcmdline_init(char **cmdline_p) | ||||
|  { | ||||
| +	bool dt_bootargs_override = false; | ||||
|  	bool dt_bootargs = false; | ||||
|   | ||||
|  	/* | ||||
| @@ -586,6 +606,14 @@ static void __init bootcmdline_init(char | ||||
|  	} | ||||
|   | ||||
|  	/* | ||||
| +	 * If bootargs-override in the chosen node is set, use this as the | ||||
| +	 * command line | ||||
| +	 */ | ||||
| +	of_scan_flat_dt(bootcmdline_scan_chosen_override, &dt_bootargs_override); | ||||
| +	if (dt_bootargs_override) | ||||
| +		return; | ||||
| + | ||||
| +	/* | ||||
|  	 * If the user specified a built-in command line & | ||||
|  	 * MIPS_CMDLINE_BUILTIN_EXTEND, then the built-in command line is | ||||
|  	 * prepended to arguments from the bootloader or DT so we'll copy them | ||||
| @@ -0,0 +1,29 @@ | ||||
| From 5ede027f6c4a57ed25da872420508b7f1168b36b Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Mon, 7 Dec 2015 17:15:32 +0100 | ||||
| Subject: [PATCH 13/53] owrt: hack: fix mt7688 cache issue | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  arch/mips/kernel/setup.c |    2 +- | ||||
|  1 file changed, 1 insertion(+), 1 deletion(-) | ||||
|  | ||||
| --- a/arch/mips/kernel/setup.c | ||||
| +++ b/arch/mips/kernel/setup.c | ||||
| @@ -723,8 +723,6 @@ static void __init arch_mem_init(char ** | ||||
|  		memblock_reserve(crashk_res.start, | ||||
|  				 crashk_res.end - crashk_res.start + 1); | ||||
|  #endif | ||||
| -	device_tree_init(); | ||||
| - | ||||
|  	/* | ||||
|  	 * In order to reduce the possibility of kernel panic when failed to | ||||
|  	 * get IO TLB memory under CONFIG_SWIOTLB, it is better to allocate | ||||
| @@ -841,6 +839,7 @@ void __init setup_arch(char **cmdline_p) | ||||
|   | ||||
|  	cpu_cache_init(); | ||||
|  	paging_init(); | ||||
| +	device_tree_init(); | ||||
|  } | ||||
|   | ||||
|  unsigned long kernelsp[NR_CPUS]; | ||||
| @@ -0,0 +1,25 @@ | ||||
| From 9e6ce539092a1dd605a20bf73c655a9de58d8641 Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Mon, 7 Dec 2015 17:18:05 +0100 | ||||
| Subject: [PATCH 15/53] arch: mips: do not select illegal access driver by | ||||
|  default | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  arch/mips/ralink/Kconfig |    4 ++-- | ||||
|  1 file changed, 2 insertions(+), 2 deletions(-) | ||||
|  | ||||
| --- a/arch/mips/ralink/Kconfig | ||||
| +++ b/arch/mips/ralink/Kconfig | ||||
| @@ -14,9 +14,9 @@ config CLKEVT_RT3352 | ||||
|  	select CEVT_SYSTICK_QUIRK | ||||
|   | ||||
|  config RALINK_ILL_ACC | ||||
| -	bool | ||||
| +	bool "illegal access irq" | ||||
|  	depends on SOC_RT305X | ||||
| -	default y | ||||
| +	default n | ||||
|   | ||||
|  config IRQ_INTC | ||||
|  	bool | ||||
| @@ -0,0 +1,165 @@ | ||||
| From 4267880319bc1a2270d352e0ded6d6386242a7ef Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Tue, 12 Aug 2014 20:49:27 +0200 | ||||
| Subject: [PATCH 24/53] GPIO: add named gpio exports | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  drivers/gpio/gpiolib-of.c     |   68 +++++++++++++++++++++++++++++++++++++++++ | ||||
|  drivers/gpio/gpiolib-sysfs.c  |   10 +++++- | ||||
|  include/asm-generic/gpio.h    |    6 ++++ | ||||
|  include/linux/gpio/consumer.h |    8 +++++ | ||||
|  4 files changed, 91 insertions(+), 1 deletion(-) | ||||
|  | ||||
| --- a/drivers/gpio/gpiolib-of.c | ||||
| +++ b/drivers/gpio/gpiolib-of.c | ||||
| @@ -19,6 +19,8 @@ | ||||
|  #include <linux/pinctrl/pinctrl.h> | ||||
|  #include <linux/slab.h> | ||||
|  #include <linux/gpio/machine.h> | ||||
| +#include <linux/init.h> | ||||
| +#include <linux/platform_device.h> | ||||
|   | ||||
|  #include "gpiolib.h" | ||||
|  #include "gpiolib-of.h" | ||||
| @@ -915,3 +917,68 @@ void of_gpiochip_remove(struct gpio_chip | ||||
|  { | ||||
|  	of_node_put(chip->of_node); | ||||
|  } | ||||
| + | ||||
| +static struct of_device_id gpio_export_ids[] = { | ||||
| +	{ .compatible = "gpio-export" }, | ||||
| +	{ /* sentinel */ } | ||||
| +}; | ||||
| + | ||||
| +static int of_gpio_export_probe(struct platform_device *pdev) | ||||
| +{ | ||||
| +	struct device_node *np = pdev->dev.of_node; | ||||
| +	struct device_node *cnp; | ||||
| +	u32 val; | ||||
| +	int nb = 0; | ||||
| + | ||||
| +	for_each_child_of_node(np, cnp) { | ||||
| +		const char *name = NULL; | ||||
| +		int gpio; | ||||
| +		bool dmc; | ||||
| +		int max_gpio = 1; | ||||
| +		int i; | ||||
| + | ||||
| +		of_property_read_string(cnp, "gpio-export,name", &name); | ||||
| + | ||||
| +		if (!name) | ||||
| +			max_gpio = of_gpio_count(cnp); | ||||
| + | ||||
| +		for (i = 0; i < max_gpio; i++) { | ||||
| +			unsigned flags = 0; | ||||
| +			enum of_gpio_flags of_flags; | ||||
| + | ||||
| +			gpio = of_get_gpio_flags(cnp, i, &of_flags); | ||||
| +			if (!gpio_is_valid(gpio)) | ||||
| +				return gpio; | ||||
| + | ||||
| +			if (of_flags == OF_GPIO_ACTIVE_LOW) | ||||
| +				flags |= GPIOF_ACTIVE_LOW; | ||||
| + | ||||
| +			if (!of_property_read_u32(cnp, "gpio-export,output", &val)) | ||||
| +				flags |= val ? GPIOF_OUT_INIT_HIGH : GPIOF_OUT_INIT_LOW; | ||||
| +			else | ||||
| +				flags |= GPIOF_IN; | ||||
| + | ||||
| +			if (devm_gpio_request_one(&pdev->dev, gpio, flags, name ? name : of_node_full_name(np))) | ||||
| +				continue; | ||||
| + | ||||
| +			dmc = of_property_read_bool(cnp, "gpio-export,direction_may_change"); | ||||
| +			gpio_export_with_name(gpio, dmc, name); | ||||
| +			nb++; | ||||
| +		} | ||||
| +	} | ||||
| + | ||||
| +	dev_info(&pdev->dev, "%d gpio(s) exported\n", nb); | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static struct platform_driver gpio_export_driver = { | ||||
| +	.driver		= { | ||||
| +		.name		= "gpio-export", | ||||
| +		.owner	= THIS_MODULE, | ||||
| +		.of_match_table	= of_match_ptr(gpio_export_ids), | ||||
| +	}, | ||||
| +	.probe		= of_gpio_export_probe, | ||||
| +}; | ||||
| + | ||||
| +module_platform_driver(gpio_export_driver); | ||||
| --- a/drivers/gpio/gpiolib-sysfs.c | ||||
| +++ b/drivers/gpio/gpiolib-sysfs.c | ||||
| @@ -563,7 +563,7 @@ static struct class gpio_class = { | ||||
|   * | ||||
|   * Returns zero on success, else an error. | ||||
|   */ | ||||
| -int gpiod_export(struct gpio_desc *desc, bool direction_may_change) | ||||
| +int __gpiod_export(struct gpio_desc *desc, bool direction_may_change, const char *name) | ||||
|  { | ||||
|  	struct gpio_chip	*chip; | ||||
|  	struct gpio_device	*gdev; | ||||
| @@ -625,6 +625,8 @@ int gpiod_export(struct gpio_desc *desc, | ||||
|  	offset = gpio_chip_hwgpio(desc); | ||||
|  	if (chip->names && chip->names[offset]) | ||||
|  		ioname = chip->names[offset]; | ||||
| +	if (name) | ||||
| +		ioname = name; | ||||
|   | ||||
|  	dev = device_create_with_groups(&gpio_class, &gdev->dev, | ||||
|  					MKDEV(0, 0), data, gpio_groups, | ||||
| @@ -646,6 +648,12 @@ err_unlock: | ||||
|  	gpiod_dbg(desc, "%s: status %d\n", __func__, status); | ||||
|  	return status; | ||||
|  } | ||||
| +EXPORT_SYMBOL_GPL(__gpiod_export); | ||||
| + | ||||
| +int gpiod_export(struct gpio_desc *desc, bool direction_may_change) | ||||
| +{ | ||||
| +	return __gpiod_export(desc, direction_may_change, NULL); | ||||
| +} | ||||
|  EXPORT_SYMBOL_GPL(gpiod_export); | ||||
|   | ||||
|  static int match_export(struct device *dev, const void *desc) | ||||
| --- a/include/asm-generic/gpio.h | ||||
| +++ b/include/asm-generic/gpio.h | ||||
| @@ -127,6 +127,12 @@ static inline int gpio_export(unsigned g | ||||
|  	return gpiod_export(gpio_to_desc(gpio), direction_may_change); | ||||
|  } | ||||
|   | ||||
| +int __gpiod_export(struct gpio_desc *desc, bool direction_may_change, const char *name); | ||||
| +static inline int gpio_export_with_name(unsigned gpio, bool direction_may_change, const char *name) | ||||
| +{ | ||||
| +	return __gpiod_export(gpio_to_desc(gpio), direction_may_change, name); | ||||
| +} | ||||
| + | ||||
|  static inline int gpio_export_link(struct device *dev, const char *name, | ||||
|  				   unsigned gpio) | ||||
|  { | ||||
| --- a/include/linux/gpio/consumer.h | ||||
| +++ b/include/linux/gpio/consumer.h | ||||
| @@ -668,6 +668,7 @@ static inline void devm_acpi_dev_remove_ | ||||
|   | ||||
|  #if IS_ENABLED(CONFIG_GPIOLIB) && IS_ENABLED(CONFIG_GPIO_SYSFS) | ||||
|   | ||||
| +int _gpiod_export(struct gpio_desc *desc, bool direction_may_change, const char *name); | ||||
|  int gpiod_export(struct gpio_desc *desc, bool direction_may_change); | ||||
|  int gpiod_export_link(struct device *dev, const char *name, | ||||
|  		      struct gpio_desc *desc); | ||||
| @@ -675,6 +676,13 @@ void gpiod_unexport(struct gpio_desc *de | ||||
|   | ||||
|  #else  /* CONFIG_GPIOLIB && CONFIG_GPIO_SYSFS */ | ||||
|   | ||||
| +static inline int _gpiod_export(struct gpio_desc *desc, | ||||
| +			       bool direction_may_change, | ||||
| +			       const char *name) | ||||
| +{ | ||||
| +	return -ENOSYS; | ||||
| +} | ||||
| + | ||||
|  static inline int gpiod_export(struct gpio_desc *desc, | ||||
|  			       bool direction_may_change) | ||||
|  { | ||||
| @@ -0,0 +1,59 @@ | ||||
| From d410e5478c622c01fcf31427533df5f433df9146 Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Sun, 28 Jul 2013 19:45:30 +0200 | ||||
| Subject: [PATCH 26/53] DT: Add documentation for gpio-ralink | ||||
|  | ||||
| Describe gpio-ralink binding. | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| Cc: linux-mips@linux-mips.org | ||||
| Cc: devicetree@vger.kernel.org | ||||
| Cc: linux-gpio@vger.kernel.org | ||||
| --- | ||||
|  .../devicetree/bindings/gpio/gpio-ralink.txt       |   40 ++++++++++++++++++++ | ||||
|  1 file changed, 40 insertions(+) | ||||
|  create mode 100644 Documentation/devicetree/bindings/gpio/gpio-ralink.txt | ||||
|  | ||||
| --- /dev/null | ||||
| +++ b/Documentation/devicetree/bindings/gpio/gpio-ralink.txt | ||||
| @@ -0,0 +1,40 @@ | ||||
| +Ralink SoC GPIO controller bindings | ||||
| + | ||||
| +Required properties: | ||||
| +- compatible: | ||||
| +  - "ralink,rt2880-gpio" for Ralink controllers | ||||
| +- #gpio-cells : Should be two. | ||||
| +  - first cell is the pin number | ||||
| +  - second cell is used to specify optional parameters (unused) | ||||
| +- gpio-controller : Marks the device node as a GPIO controller | ||||
| +- reg : Physical base address and length of the controller's registers | ||||
| +- interrupt-parent: phandle to the INTC device node | ||||
| +- interrupts : Specify the INTC interrupt number | ||||
| +- ralink,num-gpios : Specify the number of GPIOs | ||||
| +- ralink,register-map : The register layout depends on the GPIO bank and actual | ||||
| +		SoC type. Register offsets need to be in this order. | ||||
| +		[ INT, EDGE, RENA, FENA, DATA, DIR, POL, SET, RESET, TOGGLE ] | ||||
| + | ||||
| +Optional properties: | ||||
| +- ralink,gpio-base : Specify the GPIO chips base number | ||||
| + | ||||
| +Example: | ||||
| + | ||||
| +	gpio0: gpio@600 { | ||||
| +		compatible = "ralink,rt5350-gpio", "ralink,rt2880-gpio"; | ||||
| + | ||||
| +		#gpio-cells = <2>; | ||||
| +		gpio-controller; | ||||
| + | ||||
| +		reg = <0x600 0x34>; | ||||
| + | ||||
| +		interrupt-parent = <&intc>; | ||||
| +		interrupts = <6>; | ||||
| + | ||||
| +		ralink,gpio-base = <0>; | ||||
| +		ralink,num-gpios = <24>; | ||||
| +		ralink,register-map = [ 00 04 08 0c | ||||
| +				20 24 28 2c | ||||
| +				30 34 ]; | ||||
| + | ||||
| +	}; | ||||
| @@ -0,0 +1,416 @@ | ||||
| From 69fdd2c4f937796b934e89c33acde9d082e27bfd Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Mon, 4 Aug 2014 20:36:29 +0200 | ||||
| Subject: [PATCH 27/53] GPIO: MIPS: ralink: add gpio driver for ralink SoC | ||||
|  | ||||
| Add gpio driver for Ralink SoC. This driver makes the gpio core on | ||||
| RT2880, RT305x, rt3352, rt3662, rt3883, rt5350 and mt7620 work. | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| Cc: linux-mips@linux-mips.org | ||||
| Cc: linux-gpio@vger.kernel.org | ||||
| --- | ||||
|  arch/mips/include/asm/mach-ralink/gpio.h |   24 ++ | ||||
|  drivers/gpio/Kconfig                     |    6 + | ||||
|  drivers/gpio/Makefile                    |    1 + | ||||
|  drivers/gpio/gpio-ralink.c               |  355 ++++++++++++++++++++++++++++++ | ||||
|  4 files changed, 386 insertions(+) | ||||
|  create mode 100644 arch/mips/include/asm/mach-ralink/gpio.h | ||||
|  create mode 100644 drivers/gpio/gpio-ralink.c | ||||
|  | ||||
| --- /dev/null | ||||
| +++ b/arch/mips/include/asm/mach-ralink/gpio.h | ||||
| @@ -0,0 +1,24 @@ | ||||
| +/* | ||||
| + *  Ralink SoC GPIO API support | ||||
| + * | ||||
| + *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org> | ||||
| + *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org> | ||||
| + * | ||||
| + *  This program is free software; you can redistribute it and/or modify it | ||||
| + *  under the terms of the GNU General Public License version 2 as published | ||||
| + *  by the Free Software Foundation. | ||||
| + * | ||||
| + */ | ||||
| + | ||||
| +#ifndef __ASM_MACH_RALINK_GPIO_H | ||||
| +#define __ASM_MACH_RALINK_GPIO_H | ||||
| + | ||||
| +#define ARCH_NR_GPIOS	128 | ||||
| +#include <asm-generic/gpio.h> | ||||
| + | ||||
| +#define gpio_get_value	__gpio_get_value | ||||
| +#define gpio_set_value	__gpio_set_value | ||||
| +#define gpio_cansleep	__gpio_cansleep | ||||
| +#define gpio_to_irq	__gpio_to_irq | ||||
| + | ||||
| +#endif /* __ASM_MACH_RALINK_GPIO_H */ | ||||
| --- a/drivers/gpio/Kconfig | ||||
| +++ b/drivers/gpio/Kconfig | ||||
| @@ -471,6 +471,12 @@ config GPIO_SNPS_CREG | ||||
|  	  where only several fields in register belong to GPIO lines and | ||||
|  	  each GPIO line owns a field with different length and on/off value. | ||||
|   | ||||
| +config GPIO_RALINK | ||||
| +	bool "Ralink GPIO Support" | ||||
| +	depends on RALINK | ||||
| +	help | ||||
| +	  Say yes here to support the Ralink SoC GPIO device | ||||
| + | ||||
|  config GPIO_SPEAR_SPICS | ||||
|  	bool "ST SPEAr13xx SPI Chip Select as GPIO support" | ||||
|  	depends on PLAT_SPEAR | ||||
| --- a/drivers/gpio/Makefile | ||||
| +++ b/drivers/gpio/Makefile | ||||
| @@ -112,6 +112,7 @@ obj-$(CONFIG_GPIO_PISOSR)		+= gpio-pisos | ||||
|  obj-$(CONFIG_GPIO_PL061)		+= gpio-pl061.o | ||||
|  obj-$(CONFIG_GPIO_PMIC_EIC_SPRD)	+= gpio-pmic-eic-sprd.o | ||||
|  obj-$(CONFIG_GPIO_PXA)			+= gpio-pxa.o | ||||
| +obj-$(CONFIG_GPIO_RALINK)		+= gpio-ralink.o | ||||
|  obj-$(CONFIG_GPIO_RASPBERRYPI_EXP)	+= gpio-raspberrypi-exp.o | ||||
|  obj-$(CONFIG_GPIO_RC5T583)		+= gpio-rc5t583.o | ||||
|  obj-$(CONFIG_GPIO_RCAR)			+= gpio-rcar.o | ||||
| --- /dev/null | ||||
| +++ b/drivers/gpio/gpio-ralink.c | ||||
| @@ -0,0 +1,341 @@ | ||||
| +/* | ||||
| + * This program is free software; you can redistribute it and/or modify it | ||||
| + * under the terms of the GNU General Public License version 2 as published | ||||
| + * by the Free Software Foundation. | ||||
| + * | ||||
| + * Copyright (C) 2009-2011 Gabor Juhos <juhosg@openwrt.org> | ||||
| + * Copyright (C) 2013 John Crispin <blogic@openwrt.org> | ||||
| + */ | ||||
| + | ||||
| +#include <linux/module.h> | ||||
| +#include <linux/io.h> | ||||
| +#include <linux/gpio.h> | ||||
| +#include <linux/spinlock.h> | ||||
| +#include <linux/platform_device.h> | ||||
| +#include <linux/of_irq.h> | ||||
| +#include <linux/irqdomain.h> | ||||
| +#include <linux/interrupt.h> | ||||
| + | ||||
| +enum ralink_gpio_reg { | ||||
| +	GPIO_REG_INT = 0, | ||||
| +	GPIO_REG_EDGE, | ||||
| +	GPIO_REG_RENA, | ||||
| +	GPIO_REG_FENA, | ||||
| +	GPIO_REG_DATA, | ||||
| +	GPIO_REG_DIR, | ||||
| +	GPIO_REG_POL, | ||||
| +	GPIO_REG_SET, | ||||
| +	GPIO_REG_RESET, | ||||
| +	GPIO_REG_TOGGLE, | ||||
| +	GPIO_REG_MAX | ||||
| +}; | ||||
| + | ||||
| +struct ralink_gpio_chip { | ||||
| +	struct gpio_chip chip; | ||||
| +	u8 regs[GPIO_REG_MAX]; | ||||
| + | ||||
| +	spinlock_t lock; | ||||
| +	void __iomem *membase; | ||||
| +	struct irq_domain *domain; | ||||
| +	int irq; | ||||
| + | ||||
| +	u32 rising; | ||||
| +	u32 falling; | ||||
| +}; | ||||
| + | ||||
| +#define MAP_MAX	4 | ||||
| +static struct irq_domain *irq_map[MAP_MAX]; | ||||
| +static int irq_map_count; | ||||
| +static atomic_t irq_refcount = ATOMIC_INIT(0); | ||||
| + | ||||
| +static inline struct ralink_gpio_chip *to_ralink_gpio(struct gpio_chip *chip) | ||||
| +{ | ||||
| +	struct ralink_gpio_chip *rg; | ||||
| + | ||||
| +	rg = container_of(chip, struct ralink_gpio_chip, chip); | ||||
| + | ||||
| +	return rg; | ||||
| +} | ||||
| + | ||||
| +static inline void rt_gpio_w32(struct ralink_gpio_chip *rg, u8 reg, u32 val) | ||||
| +{ | ||||
| +	iowrite32(val, rg->membase + rg->regs[reg]); | ||||
| +} | ||||
| + | ||||
| +static inline u32 rt_gpio_r32(struct ralink_gpio_chip *rg, u8 reg) | ||||
| +{ | ||||
| +	return ioread32(rg->membase + rg->regs[reg]); | ||||
| +} | ||||
| + | ||||
| +static void ralink_gpio_set(struct gpio_chip *chip, unsigned offset, int value) | ||||
| +{ | ||||
| +	struct ralink_gpio_chip *rg = to_ralink_gpio(chip); | ||||
| + | ||||
| +	rt_gpio_w32(rg, (value) ? GPIO_REG_SET : GPIO_REG_RESET, BIT(offset)); | ||||
| +} | ||||
| + | ||||
| +static int ralink_gpio_get(struct gpio_chip *chip, unsigned offset) | ||||
| +{ | ||||
| +	struct ralink_gpio_chip *rg = to_ralink_gpio(chip); | ||||
| + | ||||
| +	return !!(rt_gpio_r32(rg, GPIO_REG_DATA) & BIT(offset)); | ||||
| +} | ||||
| + | ||||
| +static int ralink_gpio_direction_input(struct gpio_chip *chip, unsigned offset) | ||||
| +{ | ||||
| +	struct ralink_gpio_chip *rg = to_ralink_gpio(chip); | ||||
| +	unsigned long flags; | ||||
| +	u32 t; | ||||
| + | ||||
| +	spin_lock_irqsave(&rg->lock, flags); | ||||
| +	t = rt_gpio_r32(rg, GPIO_REG_DIR); | ||||
| +	t &= ~BIT(offset); | ||||
| +	rt_gpio_w32(rg, GPIO_REG_DIR, t); | ||||
| +	spin_unlock_irqrestore(&rg->lock, flags); | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static int ralink_gpio_direction_output(struct gpio_chip *chip, | ||||
| +					unsigned offset, int value) | ||||
| +{ | ||||
| +	struct ralink_gpio_chip *rg = to_ralink_gpio(chip); | ||||
| +	unsigned long flags; | ||||
| +	u32 t; | ||||
| + | ||||
| +	spin_lock_irqsave(&rg->lock, flags); | ||||
| +	ralink_gpio_set(chip, offset, value); | ||||
| +	t = rt_gpio_r32(rg, GPIO_REG_DIR); | ||||
| +	t |= BIT(offset); | ||||
| +	rt_gpio_w32(rg, GPIO_REG_DIR, t); | ||||
| +	spin_unlock_irqrestore(&rg->lock, flags); | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static int ralink_gpio_to_irq(struct gpio_chip *chip, unsigned pin) | ||||
| +{ | ||||
| +	struct ralink_gpio_chip *rg = to_ralink_gpio(chip); | ||||
| + | ||||
| +	if (rg->irq < 1) | ||||
| +		return -1; | ||||
| + | ||||
| +	return irq_create_mapping(rg->domain, pin); | ||||
| +} | ||||
| + | ||||
| +static void ralink_gpio_irq_handler(struct irq_desc *desc) | ||||
| +{ | ||||
| +	int i; | ||||
| + | ||||
| +	for (i = 0; i < irq_map_count; i++) { | ||||
| +		struct irq_domain *domain = irq_map[i]; | ||||
| +		struct ralink_gpio_chip *rg; | ||||
| +		unsigned long pending; | ||||
| +		int bit; | ||||
| + | ||||
| +		rg = (struct ralink_gpio_chip *) domain->host_data; | ||||
| +		pending = rt_gpio_r32(rg, GPIO_REG_INT); | ||||
| + | ||||
| +		for_each_set_bit(bit, &pending, rg->chip.ngpio) { | ||||
| +			u32 map = irq_find_mapping(domain, bit); | ||||
| +			generic_handle_irq(map); | ||||
| +			rt_gpio_w32(rg, GPIO_REG_INT, BIT(bit)); | ||||
| +		} | ||||
| +	} | ||||
| +} | ||||
| + | ||||
| +static void ralink_gpio_irq_unmask(struct irq_data *d) | ||||
| +{ | ||||
| +	struct ralink_gpio_chip *rg; | ||||
| +	unsigned long flags; | ||||
| +	u32 rise, fall; | ||||
| + | ||||
| +	rg = (struct ralink_gpio_chip *) d->domain->host_data; | ||||
| +	rise = rt_gpio_r32(rg, GPIO_REG_RENA); | ||||
| +	fall = rt_gpio_r32(rg, GPIO_REG_FENA); | ||||
| + | ||||
| +	spin_lock_irqsave(&rg->lock, flags); | ||||
| +	rt_gpio_w32(rg, GPIO_REG_RENA, rise | (BIT(d->hwirq) & rg->rising)); | ||||
| +	rt_gpio_w32(rg, GPIO_REG_FENA, fall | (BIT(d->hwirq) & rg->falling)); | ||||
| +	spin_unlock_irqrestore(&rg->lock, flags); | ||||
| +} | ||||
| + | ||||
| +static void ralink_gpio_irq_mask(struct irq_data *d) | ||||
| +{ | ||||
| +	struct ralink_gpio_chip *rg; | ||||
| +	unsigned long flags; | ||||
| +	u32 rise, fall; | ||||
| + | ||||
| +	rg = (struct ralink_gpio_chip *) d->domain->host_data; | ||||
| +	rise = rt_gpio_r32(rg, GPIO_REG_RENA); | ||||
| +	fall = rt_gpio_r32(rg, GPIO_REG_FENA); | ||||
| + | ||||
| +	spin_lock_irqsave(&rg->lock, flags); | ||||
| +	rt_gpio_w32(rg, GPIO_REG_FENA, fall & ~BIT(d->hwirq)); | ||||
| +	rt_gpio_w32(rg, GPIO_REG_RENA, rise & ~BIT(d->hwirq)); | ||||
| +	spin_unlock_irqrestore(&rg->lock, flags); | ||||
| +} | ||||
| + | ||||
| +static int ralink_gpio_irq_type(struct irq_data *d, unsigned int type) | ||||
| +{ | ||||
| +	struct ralink_gpio_chip *rg; | ||||
| +	u32 mask = BIT(d->hwirq); | ||||
| + | ||||
| +	rg = (struct ralink_gpio_chip *) d->domain->host_data; | ||||
| + | ||||
| +	if (type == IRQ_TYPE_PROBE) { | ||||
| +		if ((rg->rising | rg->falling) & mask) | ||||
| +			return 0; | ||||
| + | ||||
| +		type = IRQ_TYPE_EDGE_RISING | IRQ_TYPE_EDGE_FALLING; | ||||
| +	} | ||||
| + | ||||
| +	if (type & IRQ_TYPE_EDGE_RISING) | ||||
| +		rg->rising |= mask; | ||||
| +	else | ||||
| +		rg->rising &= ~mask; | ||||
| + | ||||
| +	if (type & IRQ_TYPE_EDGE_FALLING) | ||||
| +		rg->falling |= mask; | ||||
| +	else | ||||
| +		rg->falling &= ~mask; | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static struct irq_chip ralink_gpio_irq_chip = { | ||||
| +	.name		= "GPIO", | ||||
| +	.irq_unmask	= ralink_gpio_irq_unmask, | ||||
| +	.irq_mask	= ralink_gpio_irq_mask, | ||||
| +	.irq_mask_ack	= ralink_gpio_irq_mask, | ||||
| +	.irq_set_type	= ralink_gpio_irq_type, | ||||
| +}; | ||||
| + | ||||
| +static int gpio_map(struct irq_domain *d, unsigned int irq, irq_hw_number_t hw) | ||||
| +{ | ||||
| +	irq_set_chip_and_handler(irq, &ralink_gpio_irq_chip, handle_level_irq); | ||||
| +	irq_set_handler_data(irq, d); | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static const struct irq_domain_ops irq_domain_ops = { | ||||
| +	.xlate = irq_domain_xlate_onecell, | ||||
| +	.map = gpio_map, | ||||
| +}; | ||||
| + | ||||
| +static void ralink_gpio_irq_init(struct device_node *np, | ||||
| +				 struct ralink_gpio_chip *rg) | ||||
| +{ | ||||
| +	if (irq_map_count >= MAP_MAX) | ||||
| +		return; | ||||
| + | ||||
| +	rg->irq = irq_of_parse_and_map(np, 0); | ||||
| +	if (!rg->irq) | ||||
| +		return; | ||||
| + | ||||
| +	rg->domain = irq_domain_add_linear(np, rg->chip.ngpio, | ||||
| +					   &irq_domain_ops, rg); | ||||
| +	if (!rg->domain) { | ||||
| +		dev_err(rg->chip.parent, "irq_domain_add_linear failed\n"); | ||||
| +		return; | ||||
| +	} | ||||
| + | ||||
| +	irq_map[irq_map_count++] = rg->domain; | ||||
| + | ||||
| +	rt_gpio_w32(rg, GPIO_REG_RENA, 0x0); | ||||
| +	rt_gpio_w32(rg, GPIO_REG_FENA, 0x0); | ||||
| + | ||||
| +	if (!atomic_read(&irq_refcount)) | ||||
| +		irq_set_chained_handler(rg->irq, ralink_gpio_irq_handler); | ||||
| +	atomic_inc(&irq_refcount); | ||||
| + | ||||
| +	dev_info(rg->chip.parent, "registering %d irq handlers\n", rg->chip.ngpio); | ||||
| +} | ||||
| + | ||||
| +static int ralink_gpio_probe(struct platform_device *pdev) | ||||
| +{ | ||||
| +	struct device_node *np = pdev->dev.of_node; | ||||
| +	struct resource *res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||||
| +	struct ralink_gpio_chip *rg; | ||||
| +	const __be32 *ngpio, *gpiobase; | ||||
| + | ||||
| +	if (!res) { | ||||
| +		dev_err(&pdev->dev, "failed to find resource\n"); | ||||
| +		return -ENOMEM; | ||||
| +	} | ||||
| + | ||||
| +	rg = devm_kzalloc(&pdev->dev, | ||||
| +			sizeof(struct ralink_gpio_chip), GFP_KERNEL); | ||||
| +	if (!rg) | ||||
| +		return -ENOMEM; | ||||
| + | ||||
| +	rg->membase = devm_ioremap_resource(&pdev->dev, res); | ||||
| +	if (!rg->membase) { | ||||
| +		dev_err(&pdev->dev, "cannot remap I/O memory region\n"); | ||||
| +		return -ENOMEM; | ||||
| +	} | ||||
| + | ||||
| +	if (of_property_read_u8_array(np, "ralink,register-map", | ||||
| +			rg->regs, GPIO_REG_MAX)) { | ||||
| +		dev_err(&pdev->dev, "failed to read register definition\n"); | ||||
| +		return -EINVAL; | ||||
| +	} | ||||
| + | ||||
| +	ngpio = of_get_property(np, "ralink,num-gpios", NULL); | ||||
| +	if (!ngpio) { | ||||
| +		dev_err(&pdev->dev, "failed to read number of pins\n"); | ||||
| +		return -EINVAL; | ||||
| +	} | ||||
| + | ||||
| +	gpiobase = of_get_property(np, "ralink,gpio-base", NULL); | ||||
| +	if (gpiobase) | ||||
| +		rg->chip.base = be32_to_cpu(*gpiobase); | ||||
| +	else | ||||
| +		rg->chip.base = -1; | ||||
| + | ||||
| +	spin_lock_init(&rg->lock); | ||||
| + | ||||
| +	rg->chip.parent = &pdev->dev; | ||||
| +	rg->chip.label = dev_name(&pdev->dev); | ||||
| +	rg->chip.of_node = np; | ||||
| +	rg->chip.ngpio = be32_to_cpu(*ngpio); | ||||
| +	rg->chip.direction_input = ralink_gpio_direction_input; | ||||
| +	rg->chip.direction_output = ralink_gpio_direction_output; | ||||
| +	rg->chip.get = ralink_gpio_get; | ||||
| +	rg->chip.set = ralink_gpio_set; | ||||
| +	rg->chip.request = gpiochip_generic_request; | ||||
| +	rg->chip.to_irq = ralink_gpio_to_irq; | ||||
| +	rg->chip.free = gpiochip_generic_free; | ||||
| + | ||||
| +	/* set polarity to low for all lines */ | ||||
| +	rt_gpio_w32(rg, GPIO_REG_POL, 0); | ||||
| + | ||||
| +	dev_info(&pdev->dev, "registering %d gpios\n", rg->chip.ngpio); | ||||
| + | ||||
| +	ralink_gpio_irq_init(np, rg); | ||||
| + | ||||
| +	return gpiochip_add(&rg->chip); | ||||
| +} | ||||
| + | ||||
| +static const struct of_device_id ralink_gpio_match[] = { | ||||
| +	{ .compatible = "ralink,rt2880-gpio" }, | ||||
| +	{}, | ||||
| +}; | ||||
| +MODULE_DEVICE_TABLE(of, ralink_gpio_match); | ||||
| + | ||||
| +static struct platform_driver ralink_gpio_driver = { | ||||
| +	.probe = ralink_gpio_probe, | ||||
| +	.driver = { | ||||
| +		.name = "rt2880_gpio", | ||||
| +		.owner = THIS_MODULE, | ||||
| +		.of_match_table = ralink_gpio_match, | ||||
| +	}, | ||||
| +}; | ||||
| + | ||||
| +static int __init ralink_gpio_init(void) | ||||
| +{ | ||||
| +	return platform_driver_register(&ralink_gpio_driver); | ||||
| +} | ||||
| + | ||||
| +subsys_initcall(ralink_gpio_init); | ||||
| @@ -0,0 +1,44 @@ | ||||
| From 57fa7f2f4ef6f78ce1d30509c0d111aa3791b524 Mon Sep 17 00:00:00 2001 | ||||
| From: Daniel Santos <daniel.santos@pobox.com> | ||||
| Date: Sun, 4 Nov 2018 20:24:32 -0600 | ||||
| Subject: gpio-ralink: Add support for GPIO as interrupt-controller | ||||
|  | ||||
| Signed-off-by: Daniel Santos <daniel.santos@pobox.com> | ||||
| --- | ||||
|  Documentation/devicetree/bindings/gpio/gpio-ralink.txt | 6 ++++++ | ||||
|  drivers/gpio/gpio-ralink.c                             | 2 +- | ||||
|  2 files changed, 7 insertions(+), 1 deletion(-) | ||||
|  | ||||
| --- a/Documentation/devicetree/bindings/gpio/gpio-ralink.txt | ||||
| +++ b/Documentation/devicetree/bindings/gpio/gpio-ralink.txt | ||||
| @@ -17,6 +17,9 @@ Required properties: | ||||
|   | ||||
|  Optional properties: | ||||
|  - ralink,gpio-base : Specify the GPIO chips base number | ||||
| +- interrupt-controller : marks this as an interrupt controller | ||||
| +- #interrupt-cells : a standard two-cell interrupt flag, see | ||||
| +  interrupt-controller/interrupts.txt | ||||
|   | ||||
|  Example: | ||||
|   | ||||
| @@ -28,6 +31,9 @@ Example: | ||||
|   | ||||
|  		reg = <0x600 0x34>; | ||||
|   | ||||
| +		interrupt-controller; | ||||
| +		#interrupt-cells = <2>; | ||||
| + | ||||
|  		interrupt-parent = <&intc>; | ||||
|  		interrupts = <6>; | ||||
|   | ||||
| --- a/drivers/gpio/gpio-ralink.c | ||||
| +++ b/drivers/gpio/gpio-ralink.c | ||||
| @@ -220,7 +220,7 @@ static int gpio_map(struct irq_domain *d | ||||
|  } | ||||
|   | ||||
|  static const struct irq_domain_ops irq_domain_ops = { | ||||
| -	.xlate = irq_domain_xlate_onecell, | ||||
| +	.xlate = irq_domain_xlate_twocell, | ||||
|  	.map = gpio_map, | ||||
|  }; | ||||
|   | ||||
| @@ -0,0 +1,246 @@ | ||||
| From 975e76214cd2516eb6cfff4c3eec581872645e88 Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Thu, 19 Sep 2013 01:50:59 +0200 | ||||
| Subject: [PATCH 31/53] uvc: add iPassion iP2970 support | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  drivers/media/usb/uvc/uvc_driver.c |   12 +++ | ||||
|  drivers/media/usb/uvc/uvc_status.c |    2 + | ||||
|  drivers/media/usb/uvc/uvc_video.c  |  147 ++++++++++++++++++++++++++++++++++++ | ||||
|  drivers/media/usb/uvc/uvcvideo.h   |    5 +- | ||||
|  4 files changed, 165 insertions(+), 1 deletion(-) | ||||
|  | ||||
| --- a/drivers/media/usb/uvc/uvc_driver.c | ||||
| +++ b/drivers/media/usb/uvc/uvc_driver.c | ||||
| @@ -2908,6 +2908,18 @@ static const struct usb_device_id uvc_id | ||||
|  	  .bInterfaceSubClass	= 1, | ||||
|  	  .bInterfaceProtocol	= 0, | ||||
|  	  .driver_info		= UVC_INFO_META(V4L2_META_FMT_D4XX) }, | ||||
| +	/* iPassion iP2970 */ | ||||
| +	{ .match_flags          = USB_DEVICE_ID_MATCH_DEVICE | ||||
| +				| USB_DEVICE_ID_MATCH_INT_INFO, | ||||
| +	 .idVendor		= 0x1B3B, | ||||
| +	 .idProduct		= 0x2970, | ||||
| +	 .bInterfaceClass	= USB_CLASS_VIDEO, | ||||
| +	 .bInterfaceSubClass	= 1, | ||||
| +	 .bInterfaceProtocol	= 0, | ||||
| +	 .driver_info		= UVC_QUIRK_PROBE_MINMAX | ||||
| +				| UVC_QUIRK_STREAM_NO_FID | ||||
| +				| UVC_QUIRK_MOTION | ||||
| +				| UVC_QUIRK_SINGLE_ISO }, | ||||
|  	/* Generic USB Video Class */ | ||||
|  	{ USB_INTERFACE_INFO(USB_CLASS_VIDEO, 1, UVC_PC_PROTOCOL_UNDEFINED) }, | ||||
|  	{ USB_INTERFACE_INFO(USB_CLASS_VIDEO, 1, UVC_PC_PROTOCOL_15) }, | ||||
| --- a/drivers/media/usb/uvc/uvc_status.c | ||||
| +++ b/drivers/media/usb/uvc/uvc_status.c | ||||
| @@ -223,6 +223,7 @@ static void uvc_status_complete(struct u | ||||
|  			if (uvc_event_control(urb, status, len)) | ||||
|  				/* The URB will be resubmitted in work context. */ | ||||
|  				return; | ||||
| +			dev->motion = 1; | ||||
|  			break; | ||||
|  		} | ||||
|   | ||||
| @@ -271,6 +272,7 @@ int uvc_status_init(struct uvc_device *d | ||||
|  	} | ||||
|   | ||||
|  	pipe = usb_rcvintpipe(dev->udev, ep->desc.bEndpointAddress); | ||||
| +	dev->motion = 0; | ||||
|   | ||||
|  	/* For high-speed interrupt endpoints, the bInterval value is used as | ||||
|  	 * an exponent of two. Some developers forgot about it. | ||||
| --- a/drivers/media/usb/uvc/uvc_video.c | ||||
| +++ b/drivers/media/usb/uvc/uvc_video.c | ||||
| @@ -16,6 +16,11 @@ | ||||
|  #include <linux/wait.h> | ||||
|  #include <linux/atomic.h> | ||||
|  #include <asm/unaligned.h> | ||||
| +#include <linux/skbuff.h> | ||||
| +#include <linux/kobject.h> | ||||
| +#include <linux/netlink.h> | ||||
| +#include <linux/kobject.h> | ||||
| +#include <linux/workqueue.h> | ||||
|   | ||||
|  #include <media/v4l2-common.h> | ||||
|   | ||||
| @@ -1156,9 +1161,149 @@ static void uvc_video_decode_data(struct | ||||
|  	uvc_urb->async_operations++; | ||||
|  } | ||||
|   | ||||
| +struct bh_priv { | ||||
| +	unsigned long	seen; | ||||
| +}; | ||||
| + | ||||
| +struct bh_event { | ||||
| +	const char		*name; | ||||
| +	struct sk_buff		*skb; | ||||
| +	struct work_struct	work; | ||||
| +}; | ||||
| + | ||||
| +#define BH_ERR(fmt, args...) printk(KERN_ERR "%s: " fmt, "webcam", ##args ) | ||||
| +#define BH_DBG(fmt, args...) do {} while (0) | ||||
| +#define BH_SKB_SIZE     2048 | ||||
| + | ||||
| +extern u64 uevent_next_seqnum(void); | ||||
| +static int seen = 0; | ||||
| + | ||||
| +static int bh_event_add_var(struct bh_event *event, int argv, | ||||
| +		const char *format, ...) | ||||
| +{ | ||||
| +	static char buf[128]; | ||||
| +	char *s; | ||||
| +	va_list args; | ||||
| +	int len; | ||||
| + | ||||
| +	if (argv) | ||||
| +		return 0; | ||||
| + | ||||
| +	va_start(args, format); | ||||
| +	len = vsnprintf(buf, sizeof(buf), format, args); | ||||
| +	va_end(args); | ||||
| + | ||||
| +	if (len >= sizeof(buf)) { | ||||
| +		BH_ERR("buffer size too small\n"); | ||||
| +		WARN_ON(1); | ||||
| +		return -ENOMEM; | ||||
| +	} | ||||
| + | ||||
| +	s = skb_put(event->skb, len + 1); | ||||
| +	strcpy(s, buf); | ||||
| + | ||||
| +	BH_DBG("added variable '%s'\n", s); | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static int motion_hotplug_fill_event(struct bh_event *event) | ||||
| +{ | ||||
| +	int s = jiffies; | ||||
| +	int ret; | ||||
| + | ||||
| +	if (!seen) | ||||
| +		seen = jiffies; | ||||
| + | ||||
| +	ret = bh_event_add_var(event, 0, "HOME=%s", "/"); | ||||
| +	if (ret) | ||||
| +		return ret; | ||||
| + | ||||
| +	ret = bh_event_add_var(event, 0, "PATH=%s", | ||||
| +		"/sbin:/bin:/usr/sbin:/usr/bin"); | ||||
| +	if (ret) | ||||
| +		return ret; | ||||
| + | ||||
| +	ret = bh_event_add_var(event, 0, "SUBSYSTEM=usb"); | ||||
| +	if (ret) | ||||
| +		return ret; | ||||
| + | ||||
| +	ret = bh_event_add_var(event, 0, "ACTION=motion"); | ||||
| +	if (ret) | ||||
| +		return ret; | ||||
| + | ||||
| +	ret = bh_event_add_var(event, 0, "SEEN=%d", s - seen); | ||||
| +	if (ret) | ||||
| +		return ret; | ||||
| +	seen = s; | ||||
| + | ||||
| +	ret = bh_event_add_var(event, 0, "SEQNUM=%llu", uevent_next_seqnum()); | ||||
| + | ||||
| +	return ret; | ||||
| +} | ||||
| + | ||||
| +static void motion_hotplug_work(struct work_struct *work) | ||||
| +{ | ||||
| +	struct bh_event *event = container_of(work, struct bh_event, work); | ||||
| +	int ret = 0; | ||||
| + | ||||
| +	event->skb = alloc_skb(BH_SKB_SIZE, GFP_KERNEL); | ||||
| +	if (!event->skb) | ||||
| +		goto out_free_event; | ||||
| + | ||||
| +	ret = bh_event_add_var(event, 0, "%s@", "add"); | ||||
| +	if (ret) | ||||
| +		goto out_free_skb; | ||||
| + | ||||
| +	ret = motion_hotplug_fill_event(event); | ||||
| +	if (ret) | ||||
| +		goto out_free_skb; | ||||
| + | ||||
| +	NETLINK_CB(event->skb).dst_group = 1; | ||||
| +	broadcast_uevent(event->skb, 0, 1, GFP_KERNEL); | ||||
| + | ||||
| +out_free_skb: | ||||
| +	if (ret) { | ||||
| +		BH_ERR("work error %d\n", ret); | ||||
| +		kfree_skb(event->skb); | ||||
| +	} | ||||
| +out_free_event: | ||||
| +	kfree(event); | ||||
| +} | ||||
| + | ||||
| +static int motion_hotplug_create_event(void) | ||||
| +{ | ||||
| +	struct bh_event *event; | ||||
| + | ||||
| +	event = kzalloc(sizeof(*event), GFP_KERNEL); | ||||
| +	if (!event) | ||||
| +		return -ENOMEM; | ||||
| + | ||||
| +	event->name = "motion"; | ||||
| + | ||||
| +	INIT_WORK(&event->work, (void *)(void *)motion_hotplug_work); | ||||
| +	schedule_work(&event->work); | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +#define MOTION_FLAG_OFFSET	4 | ||||
|  static void uvc_video_decode_end(struct uvc_streaming *stream, | ||||
|  		struct uvc_buffer *buf, const u8 *data, int len) | ||||
|  { | ||||
| +	if ((stream->dev->quirks & UVC_QUIRK_MOTION) && | ||||
| +			(data[len - 2] == 0xff) && (data[len - 1] == 0xd9)) { | ||||
| +		u8 *mem; | ||||
| +		buf->state = UVC_BUF_STATE_READY; | ||||
| +		mem = (u8 *) (buf->mem + MOTION_FLAG_OFFSET); | ||||
| +		if ( stream->dev->motion ) { | ||||
| +			stream->dev->motion = 0; | ||||
| +			motion_hotplug_create_event(); | ||||
| +		} else { | ||||
| +			*mem &= 0x7f; | ||||
| +		} | ||||
| +	} | ||||
| + | ||||
|  	/* Mark the buffer as done if the EOF marker is set. */ | ||||
|  	if (data[1] & UVC_STREAM_EOF && buf->bytesused != 0) { | ||||
|  		uvc_trace(UVC_TRACE_FRAME, "Frame complete (EOF found).\n"); | ||||
| @@ -1715,6 +1860,8 @@ static int uvc_init_video_isoc(struct uv | ||||
|  	if (npackets == 0) | ||||
|  		return -ENOMEM; | ||||
|   | ||||
| +	if (stream->dev->quirks & UVC_QUIRK_SINGLE_ISO) | ||||
| +		npackets = 1; | ||||
|  	size = npackets * psize; | ||||
|   | ||||
|  	for_each_uvc_urb(uvc_urb, stream) { | ||||
| --- a/drivers/media/usb/uvc/uvcvideo.h | ||||
| +++ b/drivers/media/usb/uvc/uvcvideo.h | ||||
| @@ -199,7 +199,9 @@ | ||||
|  #define UVC_QUIRK_RESTORE_CTRLS_ON_INIT	0x00000400 | ||||
|  #define UVC_QUIRK_FORCE_Y8		0x00000800 | ||||
|  #define UVC_QUIRK_FORCE_BPP		0x00001000 | ||||
| - | ||||
| +#define UVC_QUIRK_MOTION		0x00001000 | ||||
| +#define UVC_QUIRK_SINGLE_ISO		0x00002000 | ||||
| +  | ||||
|  /* Format flags */ | ||||
|  #define UVC_FMT_FLAG_COMPRESSED		0x00000001 | ||||
|  #define UVC_FMT_FLAG_STREAM		0x00000002 | ||||
| @@ -666,6 +668,7 @@ struct uvc_device { | ||||
|  	u8 *status; | ||||
|  	struct input_dev *input; | ||||
|  	char input_phys[64]; | ||||
| +	int motion; | ||||
|   | ||||
|  	struct uvc_ctrl_work { | ||||
|  		struct work_struct work; | ||||
| @@ -0,0 +1,20 @@ | ||||
| From ee9081b2726a5ca8cde5497afdc5425e21ff8f8b Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Mon, 15 Jul 2013 00:39:21 +0200 | ||||
| Subject: [PATCH 37/53] mtd: cfi cmdset 0002 force word write | ||||
|  | ||||
| --- | ||||
|  drivers/mtd/chips/cfi_cmdset_0002.c |    9 +++++++-- | ||||
|  1 file changed, 7 insertions(+), 2 deletions(-) | ||||
|  | ||||
| --- a/drivers/mtd/chips/cfi_cmdset_0002.c | ||||
| +++ b/drivers/mtd/chips/cfi_cmdset_0002.c | ||||
| @@ -40,7 +40,7 @@ | ||||
|  #include <linux/mtd/xip.h> | ||||
|   | ||||
|  #define AMD_BOOTLOC_BUG | ||||
| -#define FORCE_WORD_WRITE 0 | ||||
| +#define FORCE_WORD_WRITE 1 | ||||
|   | ||||
|  #define MAX_RETRIES 3 | ||||
|   | ||||
| @@ -0,0 +1,44 @@ | ||||
| From da6015e7f19d749f135f7ac55c4ec47b06faa868 Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Fri, 9 Aug 2013 20:12:59 +0200 | ||||
| Subject: [PATCH 41/53] DT: Add documentation for spi-rt2880 | ||||
|  | ||||
| Describe the SPI master found on the MIPS based Ralink RT2880 SoC. | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  .../devicetree/bindings/spi/spi-rt2880.txt         |   28 ++++++++++++++++++++ | ||||
|  1 file changed, 28 insertions(+) | ||||
|  create mode 100644 Documentation/devicetree/bindings/spi/spi-rt2880.txt | ||||
|  | ||||
| --- /dev/null | ||||
| +++ b/Documentation/devicetree/bindings/spi/spi-rt2880.txt | ||||
| @@ -0,0 +1,28 @@ | ||||
| +Ralink SoC RT2880 SPI master controller. | ||||
| + | ||||
| +This SPI controller is found on most wireless SoCs made by ralink. | ||||
| + | ||||
| +Required properties: | ||||
| +- compatible : "ralink,rt2880-spi" | ||||
| +- reg : The register base for the controller. | ||||
| +- #address-cells : <1>, as required by generic SPI binding. | ||||
| +- #size-cells : <0>, also as required by generic SPI binding. | ||||
| + | ||||
| +Child nodes as per the generic SPI binding. | ||||
| + | ||||
| +Example: | ||||
| + | ||||
| +	spi@b00 { | ||||
| +		compatible = "ralink,rt2880-spi"; | ||||
| +		reg = <0xb00 0x100>; | ||||
| + | ||||
| +		#address-cells = <1>; | ||||
| +		#size-cells = <0>; | ||||
| + | ||||
| +		m25p80@0 { | ||||
| +			compatible = "m25p80"; | ||||
| +			reg = <0>; | ||||
| +			spi-max-frequency = <10000000>; | ||||
| +		}; | ||||
| +	}; | ||||
| + | ||||
| @@ -0,0 +1,574 @@ | ||||
| From 683af4ebb91a1600df1946ac4769d916b8a1be65 Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Sun, 27 Jul 2014 11:15:12 +0100 | ||||
| Subject: [PATCH 42/53] SPI: ralink: add Ralink SoC spi driver | ||||
|  | ||||
| Add the driver needed to make SPI work on Ralink SoC. | ||||
|  | ||||
| Signed-off-by: Gabor Juhos <juhosg@openwrt.org> | ||||
| Acked-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  drivers/spi/Kconfig      |    6 + | ||||
|  drivers/spi/Makefile     |    1 + | ||||
|  drivers/spi/spi-rt2880.c |  530 ++++++++++++++++++++++++++++++++++++++++++++++ | ||||
|  3 files changed, 537 insertions(+) | ||||
|  create mode 100644 drivers/spi/spi-rt2880.c | ||||
|  | ||||
| --- a/drivers/spi/Kconfig | ||||
| +++ b/drivers/spi/Kconfig | ||||
| @@ -605,6 +605,12 @@ config SPI_QCOM_GENI | ||||
|  	  This driver can also be built as a module.  If so, the module | ||||
|  	  will be called spi-geni-qcom. | ||||
|   | ||||
| +config SPI_RT2880 | ||||
| +	tristate "Ralink RT288x SPI Controller" | ||||
| +	depends on RALINK | ||||
| +	help | ||||
| +	  This selects a driver for the Ralink RT288x/RT305x SPI Controller. | ||||
| + | ||||
|  config SPI_S3C24XX | ||||
|  	tristate "Samsung S3C24XX series SPI" | ||||
|  	depends on ARCH_S3C24XX | ||||
| --- a/drivers/spi/Makefile | ||||
| +++ b/drivers/spi/Makefile | ||||
| @@ -87,6 +87,7 @@ obj-$(CONFIG_SPI_QUP)			+= spi-qup.o | ||||
|  obj-$(CONFIG_SPI_ROCKCHIP)		+= spi-rockchip.o | ||||
|  obj-$(CONFIG_SPI_RB4XX)			+= spi-rb4xx.o | ||||
|  obj-$(CONFIG_SPI_RSPI)			+= spi-rspi.o | ||||
| +obj-$(CONFIG_SPI_RT2880)		+= spi-rt2880.o | ||||
|  obj-$(CONFIG_SPI_S3C24XX)		+= spi-s3c24xx-hw.o | ||||
|  spi-s3c24xx-hw-y			:= spi-s3c24xx.o | ||||
|  spi-s3c24xx-hw-$(CONFIG_SPI_S3C24XX_FIQ) += spi-s3c24xx-fiq.o | ||||
| --- /dev/null | ||||
| +++ b/drivers/spi/spi-rt2880.c | ||||
| @@ -0,0 +1,530 @@ | ||||
| +/* | ||||
| + * spi-rt2880.c -- Ralink RT288x/RT305x SPI controller driver | ||||
| + * | ||||
| + * Copyright (C) 2011 Sergiy <piratfm@gmail.com> | ||||
| + * Copyright (C) 2011-2013 Gabor Juhos <juhosg@openwrt.org> | ||||
| + * | ||||
| + * Some parts are based on spi-orion.c: | ||||
| + *   Author: Shadi Ammouri <shadi@marvell.com> | ||||
| + *   Copyright (C) 2007-2008 Marvell Ltd. | ||||
| + * | ||||
| + * This program is free software; you can redistribute it and/or modify | ||||
| + * it under the terms of the GNU General Public License version 2 as | ||||
| + * published by the Free Software Foundation. | ||||
| + */ | ||||
| + | ||||
| +#include <linux/init.h> | ||||
| +#include <linux/module.h> | ||||
| +#include <linux/clk.h> | ||||
| +#include <linux/err.h> | ||||
| +#include <linux/delay.h> | ||||
| +#include <linux/io.h> | ||||
| +#include <linux/reset.h> | ||||
| +#include <linux/spi/spi.h> | ||||
| +#include <linux/platform_device.h> | ||||
| +#include <linux/gpio.h> | ||||
| + | ||||
| +#define DRIVER_NAME			"spi-rt2880" | ||||
| + | ||||
| +#define RAMIPS_SPI_STAT			0x00 | ||||
| +#define RAMIPS_SPI_CFG			0x10 | ||||
| +#define RAMIPS_SPI_CTL			0x14 | ||||
| +#define RAMIPS_SPI_DATA			0x20 | ||||
| +#define RAMIPS_SPI_ADDR			0x24 | ||||
| +#define RAMIPS_SPI_BS			0x28 | ||||
| +#define RAMIPS_SPI_USER			0x2C | ||||
| +#define RAMIPS_SPI_TXFIFO		0x30 | ||||
| +#define RAMIPS_SPI_RXFIFO		0x34 | ||||
| +#define RAMIPS_SPI_FIFO_STAT		0x38 | ||||
| +#define RAMIPS_SPI_MODE			0x3C | ||||
| +#define RAMIPS_SPI_DEV_OFFSET		0x40 | ||||
| +#define RAMIPS_SPI_DMA			0x80 | ||||
| +#define RAMIPS_SPI_DMASTAT		0x84 | ||||
| +#define RAMIPS_SPI_ARBITER		0xF0 | ||||
| + | ||||
| +/* SPISTAT register bit field */ | ||||
| +#define SPISTAT_BUSY			BIT(0) | ||||
| + | ||||
| +/* SPICFG register bit field */ | ||||
| +#define SPICFG_ADDRMODE			BIT(12) | ||||
| +#define SPICFG_RXENVDIS			BIT(11) | ||||
| +#define SPICFG_RXCAP			BIT(10) | ||||
| +#define SPICFG_SPIENMODE		BIT(9) | ||||
| +#define SPICFG_MSBFIRST			BIT(8) | ||||
| +#define SPICFG_SPICLKPOL		BIT(6) | ||||
| +#define SPICFG_RXCLKEDGE_FALLING	BIT(5) | ||||
| +#define SPICFG_TXCLKEDGE_FALLING	BIT(4) | ||||
| +#define SPICFG_HIZSPI			BIT(3) | ||||
| +#define SPICFG_SPICLK_PRESCALE_MASK	0x7 | ||||
| +#define SPICFG_SPICLK_DIV2		0 | ||||
| +#define SPICFG_SPICLK_DIV4		1 | ||||
| +#define SPICFG_SPICLK_DIV8		2 | ||||
| +#define SPICFG_SPICLK_DIV16		3 | ||||
| +#define SPICFG_SPICLK_DIV32		4 | ||||
| +#define SPICFG_SPICLK_DIV64		5 | ||||
| +#define SPICFG_SPICLK_DIV128		6 | ||||
| +#define SPICFG_SPICLK_DISABLE		7 | ||||
| + | ||||
| +/* SPICTL register bit field */ | ||||
| +#define SPICTL_START			BIT(4) | ||||
| +#define SPICTL_HIZSDO			BIT(3) | ||||
| +#define SPICTL_STARTWR			BIT(2) | ||||
| +#define SPICTL_STARTRD			BIT(1) | ||||
| +#define SPICTL_SPIENA			BIT(0) | ||||
| + | ||||
| +/* SPIUSER register bit field */ | ||||
| +#define SPIUSER_USERMODE		BIT(21) | ||||
| +#define SPIUSER_INSTR_PHASE		BIT(20) | ||||
| +#define SPIUSER_ADDR_PHASE_MASK		0x7 | ||||
| +#define SPIUSER_ADDR_PHASE_OFFSET	17 | ||||
| +#define SPIUSER_MODE_PHASE		BIT(16) | ||||
| +#define SPIUSER_DUMMY_PHASE_MASK	0x3 | ||||
| +#define SPIUSER_DUMMY_PHASE_OFFSET	14 | ||||
| +#define SPIUSER_DATA_PHASE_MASK		0x3 | ||||
| +#define SPIUSER_DATA_PHASE_OFFSET	12 | ||||
| +#define SPIUSER_DATA_READ		(BIT(0) << SPIUSER_DATA_PHASE_OFFSET) | ||||
| +#define SPIUSER_DATA_WRITE		(BIT(1) << SPIUSER_DATA_PHASE_OFFSET) | ||||
| +#define SPIUSER_ADDR_TYPE_OFFSET	9 | ||||
| +#define SPIUSER_MODE_TYPE_OFFSET	6 | ||||
| +#define SPIUSER_DUMMY_TYPE_OFFSET	3 | ||||
| +#define SPIUSER_DATA_TYPE_OFFSET	0 | ||||
| +#define SPIUSER_TRANSFER_MASK		0x7 | ||||
| +#define SPIUSER_TRANSFER_SINGLE		BIT(0) | ||||
| +#define SPIUSER_TRANSFER_DUAL		BIT(1) | ||||
| +#define SPIUSER_TRANSFER_QUAD		BIT(2) | ||||
| + | ||||
| +#define SPIUSER_TRANSFER_TYPE(type) ( \ | ||||
| +	(type << SPIUSER_ADDR_TYPE_OFFSET) | \ | ||||
| +	(type << SPIUSER_MODE_TYPE_OFFSET) | \ | ||||
| +	(type << SPIUSER_DUMMY_TYPE_OFFSET) | \ | ||||
| +	(type << SPIUSER_DATA_TYPE_OFFSET) \ | ||||
| +) | ||||
| + | ||||
| +/* SPIFIFOSTAT register bit field */ | ||||
| +#define SPIFIFOSTAT_TXEMPTY		BIT(19) | ||||
| +#define SPIFIFOSTAT_RXEMPTY		BIT(18) | ||||
| +#define SPIFIFOSTAT_TXFULL		BIT(17) | ||||
| +#define SPIFIFOSTAT_RXFULL		BIT(16) | ||||
| +#define SPIFIFOSTAT_FIFO_MASK		0xff | ||||
| +#define SPIFIFOSTAT_TX_OFFSET		8 | ||||
| +#define SPIFIFOSTAT_RX_OFFSET		0 | ||||
| + | ||||
| +#define SPI_FIFO_DEPTH			16 | ||||
| + | ||||
| +/* SPIMODE register bit field */ | ||||
| +#define SPIMODE_MODE_OFFSET		24 | ||||
| +#define SPIMODE_DUMMY_OFFSET		0 | ||||
| + | ||||
| +/* SPIARB register bit field */ | ||||
| +#define SPICTL_ARB_EN			BIT(31) | ||||
| +#define SPICTL_CSCTL1			BIT(16) | ||||
| +#define SPI1_POR			BIT(1) | ||||
| +#define SPI0_POR			BIT(0) | ||||
| + | ||||
| +#define RT2880_SPI_MODE_BITS	(SPI_CPOL | SPI_CPHA | SPI_LSB_FIRST | \ | ||||
| +		SPI_CS_HIGH) | ||||
| + | ||||
| +static atomic_t hw_reset_count = ATOMIC_INIT(0); | ||||
| + | ||||
| +struct rt2880_spi { | ||||
| +	struct spi_master	*master; | ||||
| +	void __iomem		*base; | ||||
| +	u32			speed; | ||||
| +	u16			wait_loops; | ||||
| +	u16			mode; | ||||
| +	struct clk		*clk; | ||||
| +}; | ||||
| + | ||||
| +static inline struct rt2880_spi *spidev_to_rt2880_spi(struct spi_device *spi) | ||||
| +{ | ||||
| +	return spi_master_get_devdata(spi->master); | ||||
| +} | ||||
| + | ||||
| +static inline u32 rt2880_spi_read(struct rt2880_spi *rs, u32 reg) | ||||
| +{ | ||||
| +	return ioread32(rs->base + reg); | ||||
| +} | ||||
| + | ||||
| +static inline void rt2880_spi_write(struct rt2880_spi *rs, u32 reg, | ||||
| +		const u32 val) | ||||
| +{ | ||||
| +	iowrite32(val, rs->base + reg); | ||||
| +} | ||||
| + | ||||
| +static inline void rt2880_spi_setbits(struct rt2880_spi *rs, u32 reg, u32 mask) | ||||
| +{ | ||||
| +	void __iomem *addr = rs->base + reg; | ||||
| + | ||||
| +	iowrite32((ioread32(addr) | mask), addr); | ||||
| +} | ||||
| + | ||||
| +static inline void rt2880_spi_clrbits(struct rt2880_spi *rs, u32 reg, u32 mask) | ||||
| +{ | ||||
| +	void __iomem *addr = rs->base + reg; | ||||
| + | ||||
| +	iowrite32((ioread32(addr) & ~mask), addr); | ||||
| +} | ||||
| + | ||||
| +static u32 rt2880_spi_baudrate_get(struct spi_device *spi, unsigned int speed) | ||||
| +{ | ||||
| +	struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); | ||||
| +	u32 rate; | ||||
| +	u32 prescale; | ||||
| + | ||||
| +	/* | ||||
| +	 * the supported rates are: 2, 4, 8, ... 128 | ||||
| +	 * round up as we look for equal or less speed | ||||
| +	 */ | ||||
| +	rate = DIV_ROUND_UP(clk_get_rate(rs->clk), speed); | ||||
| +	rate = roundup_pow_of_two(rate); | ||||
| + | ||||
| +	/* Convert the rate to SPI clock divisor value.	*/ | ||||
| +	prescale = ilog2(rate / 2); | ||||
| + | ||||
| +	/* some tolerance. double and add 100 */ | ||||
| +	rs->wait_loops = (8 * HZ * loops_per_jiffy) / | ||||
| +		(clk_get_rate(rs->clk) / rate); | ||||
| +	rs->wait_loops = (rs->wait_loops << 1) + 100; | ||||
| +	rs->speed = speed; | ||||
| + | ||||
| +	dev_dbg(&spi->dev, "speed: %lu/%u, rate: %u, prescal: %u, loops: %hu\n", | ||||
| +			clk_get_rate(rs->clk) / rate, speed, rate, prescale, | ||||
| +			rs->wait_loops); | ||||
| + | ||||
| +	return prescale; | ||||
| +} | ||||
| + | ||||
| +static u32 get_arbiter_offset(struct spi_master *master) | ||||
| +{ | ||||
| +	u32 offset; | ||||
| + | ||||
| +	offset = RAMIPS_SPI_ARBITER; | ||||
| +	if (master->bus_num == 1) | ||||
| +		offset -= RAMIPS_SPI_DEV_OFFSET; | ||||
| + | ||||
| +	return offset; | ||||
| +} | ||||
| + | ||||
| +static void rt2880_spi_set_cs(struct spi_device *spi, bool enable) | ||||
| +{ | ||||
| +	struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); | ||||
| + | ||||
| +	if (enable) | ||||
| +		rt2880_spi_setbits(rs, RAMIPS_SPI_CTL, SPICTL_SPIENA); | ||||
| +	else | ||||
| +		rt2880_spi_clrbits(rs, RAMIPS_SPI_CTL, SPICTL_SPIENA); | ||||
| +} | ||||
| + | ||||
| +static int rt2880_spi_wait_ready(struct rt2880_spi *rs, int len) | ||||
| +{ | ||||
| +	int loop = rs->wait_loops * len; | ||||
| + | ||||
| +	while ((rt2880_spi_read(rs, RAMIPS_SPI_STAT) & SPISTAT_BUSY) && --loop) | ||||
| +		cpu_relax(); | ||||
| + | ||||
| +	if (loop) | ||||
| +		return 0; | ||||
| + | ||||
| +	return -ETIMEDOUT; | ||||
| +} | ||||
| + | ||||
| +static void rt2880_dump_reg(struct spi_master *master) | ||||
| +{ | ||||
| +	struct rt2880_spi *rs = spi_master_get_devdata(master); | ||||
| + | ||||
| +	dev_dbg(&master->dev, "stat: %08x, cfg: %08x, ctl: %08x, " \ | ||||
| +			"data: %08x, arb: %08x\n", | ||||
| +			rt2880_spi_read(rs, RAMIPS_SPI_STAT), | ||||
| +			rt2880_spi_read(rs, RAMIPS_SPI_CFG), | ||||
| +			rt2880_spi_read(rs, RAMIPS_SPI_CTL), | ||||
| +			rt2880_spi_read(rs, RAMIPS_SPI_DATA), | ||||
| +			rt2880_spi_read(rs, get_arbiter_offset(master))); | ||||
| +} | ||||
| + | ||||
| +static int rt2880_spi_transfer_one(struct spi_master *master, | ||||
| +		struct spi_device *spi, struct spi_transfer *xfer) | ||||
| +{ | ||||
| +	struct rt2880_spi *rs = spi_master_get_devdata(master); | ||||
| +	unsigned len; | ||||
| +	const u8 *tx = xfer->tx_buf; | ||||
| +	u8 *rx = xfer->rx_buf; | ||||
| +	int err = 0; | ||||
| + | ||||
| +	/* change clock speed  */ | ||||
| +	if (unlikely(rs->speed != xfer->speed_hz)) { | ||||
| +		u32 reg; | ||||
| +		reg = rt2880_spi_read(rs, RAMIPS_SPI_CFG); | ||||
| +		reg &= ~SPICFG_SPICLK_PRESCALE_MASK; | ||||
| +		reg |= rt2880_spi_baudrate_get(spi, xfer->speed_hz); | ||||
| +		rt2880_spi_write(rs, RAMIPS_SPI_CFG, reg); | ||||
| +	} | ||||
| + | ||||
| +	if (tx) { | ||||
| +		len = xfer->len; | ||||
| +		while (len-- > 0) { | ||||
| +			rt2880_spi_write(rs, RAMIPS_SPI_DATA, *tx++); | ||||
| +			rt2880_spi_setbits(rs, RAMIPS_SPI_CTL, SPICTL_STARTWR); | ||||
| +			err = rt2880_spi_wait_ready(rs, 1); | ||||
| +			if (err) { | ||||
| +				dev_err(&spi->dev, "TX failed, err=%d\n", err); | ||||
| +				goto out; | ||||
| +			} | ||||
| +		} | ||||
| +	} | ||||
| + | ||||
| +	if (rx) { | ||||
| +		len = xfer->len; | ||||
| +		while (len-- > 0) { | ||||
| +			rt2880_spi_setbits(rs, RAMIPS_SPI_CTL, SPICTL_STARTRD); | ||||
| +			err = rt2880_spi_wait_ready(rs, 1); | ||||
| +			if (err) { | ||||
| +				dev_err(&spi->dev, "RX failed, err=%d\n", err); | ||||
| +				goto out; | ||||
| +			} | ||||
| +			*rx++ = (u8) rt2880_spi_read(rs, RAMIPS_SPI_DATA); | ||||
| +		} | ||||
| +	} | ||||
| + | ||||
| +out: | ||||
| +	return err; | ||||
| +} | ||||
| + | ||||
| +/* copy from spi.c */ | ||||
| +static void spi_set_cs(struct spi_device *spi, bool enable) | ||||
| +{ | ||||
| +	if (spi->mode & SPI_CS_HIGH) | ||||
| +		enable = !enable; | ||||
| + | ||||
| +	if (spi->cs_gpio >= 0) | ||||
| +		gpio_set_value(spi->cs_gpio, !enable); | ||||
| +	else if (spi->master->set_cs) | ||||
| +		spi->master->set_cs(spi, !enable); | ||||
| +} | ||||
| + | ||||
| +static int rt2880_spi_setup(struct spi_device *spi) | ||||
| +{ | ||||
| +	struct spi_master *master = spi->master; | ||||
| +	struct rt2880_spi *rs = spi_master_get_devdata(master); | ||||
| +	u32 reg, old_reg, arbit_off; | ||||
| + | ||||
| +	if ((spi->max_speed_hz > master->max_speed_hz) || | ||||
| +			(spi->max_speed_hz < master->min_speed_hz)) { | ||||
| +		dev_err(&spi->dev, "invalide requested speed %d Hz\n", | ||||
| +				spi->max_speed_hz); | ||||
| +		return -EINVAL; | ||||
| +	} | ||||
| + | ||||
| +	if (!(master->bits_per_word_mask & | ||||
| +				BIT(spi->bits_per_word - 1))) { | ||||
| +		dev_err(&spi->dev, "invalide bits_per_word %d\n", | ||||
| +				spi->bits_per_word); | ||||
| +		return -EINVAL; | ||||
| +	} | ||||
| + | ||||
| +	/* the hardware seems can't work on mode0 force it to mode3 */ | ||||
| +	if ((spi->mode & (SPI_CPOL | SPI_CPHA)) == SPI_MODE_0) { | ||||
| +		dev_warn(&spi->dev, "force spi mode3\n"); | ||||
| +		spi->mode |= SPI_MODE_3; | ||||
| +	} | ||||
| + | ||||
| +	/* chip polarity */ | ||||
| +	arbit_off = get_arbiter_offset(master); | ||||
| +	reg = old_reg = rt2880_spi_read(rs, arbit_off); | ||||
| +	if (spi->mode & SPI_CS_HIGH) { | ||||
| +		switch (master->bus_num) { | ||||
| +		case 1: | ||||
| +			reg |= SPI1_POR; | ||||
| +			break; | ||||
| +		default: | ||||
| +			reg |= SPI0_POR; | ||||
| +			break; | ||||
| +		} | ||||
| +	} else { | ||||
| +		switch (master->bus_num) { | ||||
| +		case 1: | ||||
| +			reg &= ~SPI1_POR; | ||||
| +			break; | ||||
| +		default: | ||||
| +			reg &= ~SPI0_POR; | ||||
| +			break; | ||||
| +		} | ||||
| +	} | ||||
| + | ||||
| +	/* enable spi1 */ | ||||
| +	if (master->bus_num == 1) | ||||
| +		reg |= SPICTL_ARB_EN; | ||||
| + | ||||
| +	if (reg != old_reg) | ||||
| +		rt2880_spi_write(rs, arbit_off, reg); | ||||
| + | ||||
| +	/* deselected the spi device */ | ||||
| +	spi_set_cs(spi, false); | ||||
| + | ||||
| +	rt2880_dump_reg(master); | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static int rt2880_spi_prepare_message(struct spi_master *master, | ||||
| +		struct spi_message *msg) | ||||
| +{ | ||||
| +	struct rt2880_spi *rs = spi_master_get_devdata(master); | ||||
| +	struct spi_device *spi = msg->spi; | ||||
| +	u32 reg; | ||||
| + | ||||
| +	if ((rs->mode == spi->mode) && (rs->speed == spi->max_speed_hz)) | ||||
| +		return 0; | ||||
| + | ||||
| +#if 0 | ||||
| +	/* set spido to tri-state */ | ||||
| +	rt2880_spi_setbits(rs, RAMIPS_SPI_CTL, SPICTL_HIZSDO); | ||||
| +#endif | ||||
| + | ||||
| +	reg = rt2880_spi_read(rs, RAMIPS_SPI_CFG); | ||||
| + | ||||
| +	reg &= ~(SPICFG_MSBFIRST | SPICFG_SPICLKPOL | | ||||
| +			SPICFG_RXCLKEDGE_FALLING | | ||||
| +			SPICFG_TXCLKEDGE_FALLING | | ||||
| +			SPICFG_SPICLK_PRESCALE_MASK); | ||||
| + | ||||
| +	/* MSB */ | ||||
| +	if (!(spi->mode & SPI_LSB_FIRST)) | ||||
| +		reg |= SPICFG_MSBFIRST; | ||||
| + | ||||
| +	/* spi mode */ | ||||
| +	switch (spi->mode & (SPI_CPOL | SPI_CPHA)) { | ||||
| +	case SPI_MODE_0: | ||||
| +		reg |= SPICFG_TXCLKEDGE_FALLING; | ||||
| +		break; | ||||
| +	case SPI_MODE_1: | ||||
| +		reg |= SPICFG_RXCLKEDGE_FALLING; | ||||
| +		break; | ||||
| +	case SPI_MODE_2: | ||||
| +		reg |= SPICFG_SPICLKPOL | SPICFG_RXCLKEDGE_FALLING; | ||||
| +		break; | ||||
| +	case SPI_MODE_3: | ||||
| +		reg |= SPICFG_SPICLKPOL | SPICFG_TXCLKEDGE_FALLING; | ||||
| +		break; | ||||
| +	} | ||||
| +	rs->mode = spi->mode; | ||||
| + | ||||
| +#if 0 | ||||
| +	/* set spiclk and spiena to tri-state */ | ||||
| +	reg |= SPICFG_HIZSPI; | ||||
| +#endif | ||||
| + | ||||
| +	/* clock divide */ | ||||
| +	reg |= rt2880_spi_baudrate_get(spi, spi->max_speed_hz); | ||||
| + | ||||
| +	rt2880_spi_write(rs, RAMIPS_SPI_CFG, reg); | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static int rt2880_spi_probe(struct platform_device *pdev) | ||||
| +{ | ||||
| +	struct spi_master *master; | ||||
| +	struct rt2880_spi *rs; | ||||
| +	void __iomem *base; | ||||
| +	struct resource *r; | ||||
| +	struct clk *clk; | ||||
| +	int ret; | ||||
| + | ||||
| +	r = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||||
| +	base = devm_ioremap_resource(&pdev->dev, r); | ||||
| +	if (IS_ERR(base)) | ||||
| +		return PTR_ERR(base); | ||||
| + | ||||
| +	clk = devm_clk_get(&pdev->dev, NULL); | ||||
| +	if (IS_ERR(clk)) { | ||||
| +		dev_err(&pdev->dev, "unable to get SYS clock\n"); | ||||
| +		return PTR_ERR(clk); | ||||
| +	} | ||||
| + | ||||
| +	ret = clk_prepare_enable(clk); | ||||
| +	if (ret) | ||||
| +		goto err_clk; | ||||
| + | ||||
| +	master = spi_alloc_master(&pdev->dev, sizeof(*rs)); | ||||
| +	if (master == NULL) { | ||||
| +		dev_dbg(&pdev->dev, "master allocation failed\n"); | ||||
| +		ret = -ENOMEM; | ||||
| +		goto err_clk; | ||||
| +	} | ||||
| + | ||||
| +	master->dev.of_node = pdev->dev.of_node; | ||||
| +	master->mode_bits = RT2880_SPI_MODE_BITS; | ||||
| +	master->bits_per_word_mask = SPI_BPW_MASK(8); | ||||
| +	master->min_speed_hz = clk_get_rate(clk) / 128; | ||||
| +	master->max_speed_hz = clk_get_rate(clk) / 2; | ||||
| +	master->flags = SPI_MASTER_HALF_DUPLEX; | ||||
| +	master->setup = rt2880_spi_setup; | ||||
| +	master->prepare_message = rt2880_spi_prepare_message; | ||||
| +	master->set_cs = rt2880_spi_set_cs; | ||||
| +	master->transfer_one = rt2880_spi_transfer_one, | ||||
| + | ||||
| +	dev_set_drvdata(&pdev->dev, master); | ||||
| + | ||||
| +	rs = spi_master_get_devdata(master); | ||||
| +	rs->master = master; | ||||
| +	rs->base = base; | ||||
| +	rs->clk = clk; | ||||
| + | ||||
| +	if (atomic_inc_return(&hw_reset_count) == 1) | ||||
| +		device_reset(&pdev->dev); | ||||
| + | ||||
| +	ret = devm_spi_register_master(&pdev->dev, master); | ||||
| +	if (ret < 0) { | ||||
| +		dev_err(&pdev->dev, "devm_spi_register_master error.\n"); | ||||
| +		goto err_master; | ||||
| +	} | ||||
| + | ||||
| +	return ret; | ||||
| + | ||||
| +err_master: | ||||
| +	spi_master_put(master); | ||||
| +	kfree(master); | ||||
| +err_clk: | ||||
| +	clk_disable_unprepare(clk); | ||||
| + | ||||
| +	return ret; | ||||
| +} | ||||
| + | ||||
| +static int rt2880_spi_remove(struct platform_device *pdev) | ||||
| +{ | ||||
| +	struct spi_master *master; | ||||
| +	struct rt2880_spi *rs; | ||||
| + | ||||
| +	master = dev_get_drvdata(&pdev->dev); | ||||
| +	rs = spi_master_get_devdata(master); | ||||
| + | ||||
| +	clk_disable_unprepare(rs->clk); | ||||
| +	atomic_dec(&hw_reset_count); | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +MODULE_ALIAS("platform:" DRIVER_NAME); | ||||
| + | ||||
| +static const struct of_device_id rt2880_spi_match[] = { | ||||
| +	{ .compatible = "ralink,rt2880-spi" }, | ||||
| +	{}, | ||||
| +}; | ||||
| +MODULE_DEVICE_TABLE(of, rt2880_spi_match); | ||||
| + | ||||
| +static struct platform_driver rt2880_spi_driver = { | ||||
| +	.driver = { | ||||
| +		.name = DRIVER_NAME, | ||||
| +		.owner = THIS_MODULE, | ||||
| +		.of_match_table = rt2880_spi_match, | ||||
| +	}, | ||||
| +	.probe = rt2880_spi_probe, | ||||
| +	.remove = rt2880_spi_remove, | ||||
| +}; | ||||
| + | ||||
| +module_platform_driver(rt2880_spi_driver); | ||||
| + | ||||
| +MODULE_DESCRIPTION("Ralink SPI driver"); | ||||
| +MODULE_AUTHOR("Sergiy <piratfm@gmail.com>"); | ||||
| +MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>"); | ||||
| +MODULE_LICENSE("GPL"); | ||||
| @@ -0,0 +1,507 @@ | ||||
| From 723b8beaabf3c3c4b1ce69480141f1e926f3f3b2 Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Sun, 27 Jul 2014 09:52:56 +0100 | ||||
| Subject: [PATCH 44/53] i2c: MIPS: adds ralink I2C driver | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  .../devicetree/bindings/i2c/i2c-ralink.txt         |   27 ++ | ||||
|  drivers/i2c/busses/Kconfig                         |    4 + | ||||
|  drivers/i2c/busses/Makefile                        |    1 + | ||||
|  drivers/i2c/busses/i2c-ralink.c                    |  327 ++++++++++++++++++++ | ||||
|  4 files changed, 359 insertions(+) | ||||
|  create mode 100644 Documentation/devicetree/bindings/i2c/i2c-ralink.txt | ||||
|  create mode 100644 drivers/i2c/busses/i2c-ralink.c | ||||
|  | ||||
| --- /dev/null | ||||
| +++ b/Documentation/devicetree/bindings/i2c/i2c-ralink.txt | ||||
| @@ -0,0 +1,27 @@ | ||||
| +I2C for Ralink platforms | ||||
| + | ||||
| +Required properties : | ||||
| +- compatible : Must be "link,rt3052-i2c" | ||||
| +- reg: physical base address of the controller and length of memory mapped | ||||
| +     region. | ||||
| +- #address-cells = <1>; | ||||
| +- #size-cells = <0>; | ||||
| + | ||||
| +Optional properties: | ||||
| +- Child nodes conforming to i2c bus binding | ||||
| + | ||||
| +Example : | ||||
| + | ||||
| +palmbus@10000000 { | ||||
| +	i2c@900 { | ||||
| +		compatible = "link,rt3052-i2c"; | ||||
| +		reg = <0x900 0x100>; | ||||
| +		#address-cells = <1>; | ||||
| +		#size-cells = <0>; | ||||
| + | ||||
| +		hwmon@4b { | ||||
| +			compatible = "national,lm92"; | ||||
| +			reg = <0x4b>; | ||||
| +		}; | ||||
| +	}; | ||||
| +}; | ||||
| --- a/drivers/i2c/busses/Kconfig | ||||
| +++ b/drivers/i2c/busses/Kconfig | ||||
| @@ -922,6 +922,11 @@ config I2C_RK3X | ||||
|  	  This driver can also be built as a module. If so, the module will | ||||
|  	  be called i2c-rk3x. | ||||
|   | ||||
| +config I2C_RALINK | ||||
| +	tristate "Ralink I2C Controller" | ||||
| +	depends on RALINK && !SOC_MT7621 | ||||
| +	select OF_I2C | ||||
| + | ||||
|  config HAVE_S3C2410_I2C | ||||
|  	bool | ||||
|  	help | ||||
| --- a/drivers/i2c/busses/Makefile | ||||
| +++ b/drivers/i2c/busses/Makefile | ||||
| @@ -91,6 +91,7 @@ obj-$(CONFIG_I2C_PNX)		+= i2c-pnx.o | ||||
|  obj-$(CONFIG_I2C_PUV3)		+= i2c-puv3.o | ||||
|  obj-$(CONFIG_I2C_PXA)		+= i2c-pxa.o | ||||
|  obj-$(CONFIG_I2C_PXA_PCI)	+= i2c-pxa-pci.o | ||||
| +obj-$(CONFIG_I2C_RALINK)	+= i2c-ralink.o | ||||
|  obj-$(CONFIG_I2C_QCOM_GENI)	+= i2c-qcom-geni.o | ||||
|  obj-$(CONFIG_I2C_QUP)		+= i2c-qup.o | ||||
|  obj-$(CONFIG_I2C_RIIC)		+= i2c-riic.o | ||||
| --- /dev/null | ||||
| +++ b/drivers/i2c/busses/i2c-ralink.c | ||||
| @@ -0,0 +1,435 @@ | ||||
| +/* | ||||
| + * drivers/i2c/busses/i2c-ralink.c | ||||
| + * | ||||
| + * Copyright (C) 2013 Steven Liu <steven_liu@mediatek.com> | ||||
| + * Copyright (C) 2016 Michael Lee <igvtee@gmail.com> | ||||
| + * | ||||
| + * Improve driver for i2cdetect from i2c-tools to detect i2c devices on the bus. | ||||
| + * (C) 2014 Sittisak <sittisaks@hotmail.com> | ||||
| + * | ||||
| + * This software is licensed under the terms of the GNU General Public | ||||
| + * License version 2, as published by the Free Software Foundation, and | ||||
| + * may be copied, distributed, and modified under those terms. | ||||
| + * | ||||
| + * This program is distributed in the hope that it will be useful, | ||||
| + * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||||
| + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | ||||
| + * GNU General Public License for more details. | ||||
| + * | ||||
| + */ | ||||
| + | ||||
| +#include <linux/interrupt.h> | ||||
| +#include <linux/kernel.h> | ||||
| +#include <linux/module.h> | ||||
| +#include <linux/reset.h> | ||||
| +#include <linux/delay.h> | ||||
| +#include <linux/slab.h> | ||||
| +#include <linux/init.h> | ||||
| +#include <linux/errno.h> | ||||
| +#include <linux/platform_device.h> | ||||
| +#include <linux/of_platform.h> | ||||
| +#include <linux/i2c.h> | ||||
| +#include <linux/io.h> | ||||
| +#include <linux/err.h> | ||||
| +#include <linux/clk.h> | ||||
| + | ||||
| +#define REG_CONFIG_REG		0x00 | ||||
| +#define REG_CLKDIV_REG		0x04 | ||||
| +#define REG_DEVADDR_REG		0x08 | ||||
| +#define REG_ADDR_REG		0x0C | ||||
| +#define REG_DATAOUT_REG		0x10 | ||||
| +#define REG_DATAIN_REG		0x14 | ||||
| +#define REG_STATUS_REG		0x18 | ||||
| +#define REG_STARTXFR_REG	0x1C | ||||
| +#define REG_BYTECNT_REG		0x20 | ||||
| + | ||||
| +/* REG_CONFIG_REG */ | ||||
| +#define I2C_ADDRLEN_OFFSET	5 | ||||
| +#define I2C_DEVADLEN_OFFSET	2 | ||||
| +#define I2C_ADDRLEN_MASK	0x3 | ||||
| +#define I2C_ADDR_DIS		BIT(1) | ||||
| +#define I2C_DEVADDR_DIS		BIT(0) | ||||
| +#define I2C_ADDRLEN_8		(7 << I2C_ADDRLEN_OFFSET) | ||||
| +#define I2C_DEVADLEN_7		(6 << I2C_DEVADLEN_OFFSET) | ||||
| +#define I2C_CONF_DEFAULT	(I2C_ADDRLEN_8 | I2C_DEVADLEN_7) | ||||
| + | ||||
| +/* REG_CLKDIV_REG */ | ||||
| +#define I2C_CLKDIV_MASK		0xffff | ||||
| + | ||||
| +/* REG_DEVADDR_REG */ | ||||
| +#define I2C_DEVADDR_MASK	0x7f | ||||
| + | ||||
| +/* REG_ADDR_REG */ | ||||
| +#define I2C_ADDR_MASK		0xff | ||||
| + | ||||
| +/* REG_STATUS_REG */ | ||||
| +#define I2C_STARTERR		BIT(4) | ||||
| +#define I2C_ACKERR		BIT(3) | ||||
| +#define I2C_DATARDY		BIT(2) | ||||
| +#define I2C_SDOEMPTY		BIT(1) | ||||
| +#define I2C_BUSY		BIT(0) | ||||
| + | ||||
| +/* REG_STARTXFR_REG */ | ||||
| +#define NOSTOP_CMD		BIT(2) | ||||
| +#define NODATA_CMD		BIT(1) | ||||
| +#define READ_CMD		BIT(0) | ||||
| + | ||||
| +/* REG_BYTECNT_REG */ | ||||
| +#define BYTECNT_MAX		64 | ||||
| +#define SET_BYTECNT(x)		(x - 1) | ||||
| + | ||||
| +/* timeout waiting for I2C devices to respond (clock streching) */ | ||||
| +#define TIMEOUT_MS              1000 | ||||
| +#define DELAY_INTERVAL_US       100 | ||||
| + | ||||
| +struct rt_i2c { | ||||
| +	void __iomem *base; | ||||
| +	struct clk *clk; | ||||
| +	struct device *dev; | ||||
| +	struct i2c_adapter adap; | ||||
| +	u32 cur_clk; | ||||
| +	u32 clk_div; | ||||
| +	u32 flags; | ||||
| +}; | ||||
| + | ||||
| +static void rt_i2c_w32(struct rt_i2c *i2c, u32 val, unsigned reg) | ||||
| +{ | ||||
| +	iowrite32(val, i2c->base + reg); | ||||
| +} | ||||
| + | ||||
| +static u32 rt_i2c_r32(struct rt_i2c *i2c, unsigned reg) | ||||
| +{ | ||||
| +	return ioread32(i2c->base + reg); | ||||
| +} | ||||
| + | ||||
| +static int poll_down_timeout(void __iomem *addr, u32 mask) | ||||
| +{ | ||||
| +	unsigned long timeout = jiffies + msecs_to_jiffies(TIMEOUT_MS); | ||||
| + | ||||
| +	do { | ||||
| +		if (!(readl_relaxed(addr) & mask)) | ||||
| +			return 0; | ||||
| + | ||||
| +		usleep_range(DELAY_INTERVAL_US, DELAY_INTERVAL_US + 50); | ||||
| +	} while (time_before(jiffies, timeout)); | ||||
| + | ||||
| +	return (readl_relaxed(addr) & mask) ? -EAGAIN : 0; | ||||
| +} | ||||
| + | ||||
| +static int rt_i2c_wait_idle(struct rt_i2c *i2c) | ||||
| +{ | ||||
| +	int ret; | ||||
| + | ||||
| +	ret = poll_down_timeout(i2c->base + REG_STATUS_REG, I2C_BUSY); | ||||
| +	if (ret < 0) | ||||
| +		dev_dbg(i2c->dev, "idle err(%d)\n", ret); | ||||
| + | ||||
| +	return ret; | ||||
| +} | ||||
| + | ||||
| +static int poll_up_timeout(void __iomem *addr, u32 mask) | ||||
| +{ | ||||
| +	unsigned long timeout = jiffies + msecs_to_jiffies(TIMEOUT_MS); | ||||
| +	u32 status; | ||||
| + | ||||
| +	do { | ||||
| +		status = readl_relaxed(addr); | ||||
| + | ||||
| +		/* check error status */ | ||||
| +		if (status & I2C_STARTERR) | ||||
| +			return -EAGAIN; | ||||
| +		else if (status & I2C_ACKERR) | ||||
| +			return -ENXIO; | ||||
| +		else if (status & mask) | ||||
| +			return 0; | ||||
| + | ||||
| +		usleep_range(DELAY_INTERVAL_US, DELAY_INTERVAL_US + 50); | ||||
| +	} while (time_before(jiffies, timeout)); | ||||
| + | ||||
| +	return -ETIMEDOUT; | ||||
| +} | ||||
| + | ||||
| +static int rt_i2c_wait_rx_done(struct rt_i2c *i2c) | ||||
| +{ | ||||
| +	int ret; | ||||
| + | ||||
| +	ret = poll_up_timeout(i2c->base + REG_STATUS_REG, I2C_DATARDY); | ||||
| +	if (ret < 0) | ||||
| +		dev_dbg(i2c->dev, "rx err(%d)\n", ret); | ||||
| + | ||||
| +	return ret; | ||||
| +} | ||||
| + | ||||
| +static int rt_i2c_wait_tx_done(struct rt_i2c *i2c) | ||||
| +{ | ||||
| +	int ret; | ||||
| + | ||||
| +	ret = poll_up_timeout(i2c->base + REG_STATUS_REG, I2C_SDOEMPTY); | ||||
| +	if (ret < 0) | ||||
| +		dev_dbg(i2c->dev, "tx err(%d)\n", ret); | ||||
| + | ||||
| +	return ret; | ||||
| +} | ||||
| + | ||||
| +static void rt_i2c_reset(struct rt_i2c *i2c) | ||||
| +{ | ||||
| +	device_reset(i2c->adap.dev.parent); | ||||
| +	barrier(); | ||||
| +	rt_i2c_w32(i2c, i2c->clk_div, REG_CLKDIV_REG); | ||||
| +} | ||||
| + | ||||
| +static void rt_i2c_dump_reg(struct rt_i2c *i2c) | ||||
| +{ | ||||
| +	dev_dbg(i2c->dev, "conf %08x, clkdiv %08x, devaddr %08x, " \ | ||||
| +			"addr %08x, dataout %08x, datain %08x, " \ | ||||
| +			"status %08x, startxfr %08x, bytecnt %08x\n", | ||||
| +			rt_i2c_r32(i2c, REG_CONFIG_REG), | ||||
| +			rt_i2c_r32(i2c, REG_CLKDIV_REG), | ||||
| +			rt_i2c_r32(i2c, REG_DEVADDR_REG), | ||||
| +			rt_i2c_r32(i2c, REG_ADDR_REG), | ||||
| +			rt_i2c_r32(i2c, REG_DATAOUT_REG), | ||||
| +			rt_i2c_r32(i2c, REG_DATAIN_REG), | ||||
| +			rt_i2c_r32(i2c, REG_STATUS_REG), | ||||
| +			rt_i2c_r32(i2c, REG_STARTXFR_REG), | ||||
| +			rt_i2c_r32(i2c, REG_BYTECNT_REG)); | ||||
| +} | ||||
| + | ||||
| +static int rt_i2c_master_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, | ||||
| +		int num) | ||||
| +{ | ||||
| +	struct rt_i2c *i2c; | ||||
| +	struct i2c_msg *pmsg; | ||||
| +	unsigned char addr; | ||||
| +	int i, j, ret; | ||||
| +	u32 cmd; | ||||
| + | ||||
| +	i2c = i2c_get_adapdata(adap); | ||||
| + | ||||
| +	for (i = 0; i < num; i++) { | ||||
| +		pmsg = &msgs[i]; | ||||
| +		if (i == (num - 1)) | ||||
| +			cmd = 0; | ||||
| +		else | ||||
| +			cmd = NOSTOP_CMD; | ||||
| + | ||||
| +		dev_dbg(i2c->dev, "addr: 0x%x, len: %d, flags: 0x%x, stop: %d\n", | ||||
| +				pmsg->addr, pmsg->len, pmsg->flags, | ||||
| +				(cmd == 0)? 1 : 0); | ||||
| + | ||||
| +		/* wait hardware idle */ | ||||
| +		if ((ret = rt_i2c_wait_idle(i2c))) | ||||
| +			goto err_timeout; | ||||
| + | ||||
| +		if (pmsg->flags & I2C_M_TEN) { | ||||
| +			rt_i2c_w32(i2c, I2C_CONF_DEFAULT, REG_CONFIG_REG); | ||||
| +			/* 10 bits address */ | ||||
| +			addr = 0x78 | ((pmsg->addr >> 8) & 0x03); | ||||
| +			rt_i2c_w32(i2c, addr & I2C_DEVADDR_MASK, | ||||
| +					REG_DEVADDR_REG); | ||||
| +			rt_i2c_w32(i2c, pmsg->addr & I2C_ADDR_MASK, | ||||
| +					REG_ADDR_REG); | ||||
| +		} else { | ||||
| +			rt_i2c_w32(i2c, I2C_CONF_DEFAULT | I2C_ADDR_DIS, | ||||
| +					REG_CONFIG_REG); | ||||
| +			/* 7 bits address */ | ||||
| +			rt_i2c_w32(i2c, pmsg->addr & I2C_DEVADDR_MASK, | ||||
| +					REG_DEVADDR_REG); | ||||
| +		} | ||||
| + | ||||
| +		/* buffer length */ | ||||
| +		if (pmsg->len == 0) | ||||
| +			cmd |= NODATA_CMD; | ||||
| +		else | ||||
| +			rt_i2c_w32(i2c, SET_BYTECNT(pmsg->len), | ||||
| +					REG_BYTECNT_REG); | ||||
| + | ||||
| +		j = 0; | ||||
| +		if (pmsg->flags & I2C_M_RD) { | ||||
| +			cmd |= READ_CMD; | ||||
| +			/* start transfer */ | ||||
| +			barrier(); | ||||
| +			rt_i2c_w32(i2c, cmd, REG_STARTXFR_REG); | ||||
| +			do { | ||||
| +				/* wait */ | ||||
| +				if ((ret = rt_i2c_wait_rx_done(i2c))) | ||||
| +					goto err_timeout; | ||||
| +				/* read data */ | ||||
| +				if (pmsg->len) | ||||
| +					pmsg->buf[j] = rt_i2c_r32(i2c, | ||||
| +							REG_DATAIN_REG); | ||||
| +				j++; | ||||
| +			} while (j < pmsg->len); | ||||
| +		} else { | ||||
| +			do { | ||||
| +				/* write data */ | ||||
| +				if (pmsg->len) | ||||
| +					rt_i2c_w32(i2c, pmsg->buf[j], | ||||
| +							REG_DATAOUT_REG); | ||||
| +				/* start transfer */ | ||||
| +				if (j == 0) { | ||||
| +					barrier(); | ||||
| +					rt_i2c_w32(i2c, cmd, REG_STARTXFR_REG); | ||||
| +				} | ||||
| +				/* wait */ | ||||
| +				if ((ret = rt_i2c_wait_tx_done(i2c))) | ||||
| +					goto err_timeout; | ||||
| +				j++; | ||||
| +			} while (j < pmsg->len); | ||||
| +		} | ||||
| +	} | ||||
| +	/* the return value is number of executed messages */ | ||||
| +	ret = i; | ||||
| + | ||||
| +	return ret; | ||||
| + | ||||
| +err_timeout: | ||||
| +	rt_i2c_dump_reg(i2c); | ||||
| +	rt_i2c_reset(i2c); | ||||
| +	return ret; | ||||
| +} | ||||
| + | ||||
| +static u32 rt_i2c_func(struct i2c_adapter *a) | ||||
| +{ | ||||
| +	return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; | ||||
| +} | ||||
| + | ||||
| +static const struct i2c_algorithm rt_i2c_algo = { | ||||
| +	.master_xfer	= rt_i2c_master_xfer, | ||||
| +	.functionality	= rt_i2c_func, | ||||
| +}; | ||||
| + | ||||
| +static const struct of_device_id i2c_rt_dt_ids[] = { | ||||
| +	{ .compatible = "ralink,rt2880-i2c" }, | ||||
| +	{ /* sentinel */ } | ||||
| +}; | ||||
| + | ||||
| +MODULE_DEVICE_TABLE(of, i2c_rt_dt_ids); | ||||
| + | ||||
| +static struct i2c_adapter_quirks rt_i2c_quirks = { | ||||
| +        .max_write_len = BYTECNT_MAX, | ||||
| +        .max_read_len = BYTECNT_MAX, | ||||
| +}; | ||||
| + | ||||
| +static int rt_i2c_init(struct rt_i2c *i2c) | ||||
| +{ | ||||
| +	u32 reg; | ||||
| + | ||||
| +	/* i2c_sclk = periph_clk / ((2 * clk_div) + 5) */ | ||||
| +	i2c->clk_div = (clk_get_rate(i2c->clk) - (5 * i2c->cur_clk)) / | ||||
| +		(2 * i2c->cur_clk); | ||||
| +	if (i2c->clk_div < 8) | ||||
| +		i2c->clk_div = 8; | ||||
| +	if (i2c->clk_div > I2C_CLKDIV_MASK) | ||||
| +		i2c->clk_div = I2C_CLKDIV_MASK; | ||||
| + | ||||
| +	/* check support combinde/repeated start message */ | ||||
| +	rt_i2c_w32(i2c, NOSTOP_CMD, REG_STARTXFR_REG); | ||||
| +	reg = rt_i2c_r32(i2c, REG_STARTXFR_REG) & NOSTOP_CMD; | ||||
| + | ||||
| +	rt_i2c_reset(i2c); | ||||
| + | ||||
| +	return reg; | ||||
| +} | ||||
| + | ||||
| +static int rt_i2c_probe(struct platform_device *pdev) | ||||
| +{ | ||||
| +	struct resource *res; | ||||
| +	struct rt_i2c *i2c; | ||||
| +	struct i2c_adapter *adap; | ||||
| +	const struct of_device_id *match; | ||||
| +	int ret, restart; | ||||
| + | ||||
| +	match = of_match_device(i2c_rt_dt_ids, &pdev->dev); | ||||
| + | ||||
| +	res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||||
| +	if (!res) { | ||||
| +		dev_err(&pdev->dev, "no memory resource found\n"); | ||||
| +		return -ENODEV; | ||||
| +	} | ||||
| + | ||||
| +	i2c = devm_kzalloc(&pdev->dev, sizeof(struct rt_i2c), GFP_KERNEL); | ||||
| +	if (!i2c) { | ||||
| +		dev_err(&pdev->dev, "failed to allocate i2c_adapter\n"); | ||||
| +		return -ENOMEM; | ||||
| +	} | ||||
| + | ||||
| +	i2c->base = devm_ioremap_resource(&pdev->dev, res); | ||||
| +	if (IS_ERR(i2c->base)) | ||||
| +		return PTR_ERR(i2c->base); | ||||
| + | ||||
| +	i2c->clk = devm_clk_get(&pdev->dev, NULL); | ||||
| +	if (IS_ERR(i2c->clk)) { | ||||
| +		dev_err(&pdev->dev, "no clock defined\n"); | ||||
| +		return -ENODEV; | ||||
| +	} | ||||
| +	clk_prepare_enable(i2c->clk); | ||||
| +	i2c->dev = &pdev->dev; | ||||
| + | ||||
| +	if (of_property_read_u32(pdev->dev.of_node, | ||||
| +				"clock-frequency", &i2c->cur_clk)) | ||||
| +		i2c->cur_clk = 100000; | ||||
| + | ||||
| +	adap = &i2c->adap; | ||||
| +	adap->owner = THIS_MODULE; | ||||
| +	adap->class = I2C_CLASS_HWMON | I2C_CLASS_SPD; | ||||
| +	adap->algo = &rt_i2c_algo; | ||||
| +	adap->retries = 3; | ||||
| +	adap->dev.parent = &pdev->dev; | ||||
| +	i2c_set_adapdata(adap, i2c); | ||||
| +	adap->dev.of_node = pdev->dev.of_node; | ||||
| +	strlcpy(adap->name, dev_name(&pdev->dev), sizeof(adap->name)); | ||||
| +	adap->quirks = &rt_i2c_quirks; | ||||
| + | ||||
| +	platform_set_drvdata(pdev, i2c); | ||||
| + | ||||
| +	restart = rt_i2c_init(i2c); | ||||
| + | ||||
| +	ret = i2c_add_adapter(adap); | ||||
| +	if (ret < 0) { | ||||
| +		dev_err(&pdev->dev, "failed to add adapter\n"); | ||||
| +		clk_disable_unprepare(i2c->clk); | ||||
| +		return ret; | ||||
| +	} | ||||
| + | ||||
| +	dev_info(&pdev->dev, "clock %uKHz, re-start %ssupport\n", | ||||
| +			i2c->cur_clk/1000, restart ? "" : "not "); | ||||
| + | ||||
| +	return ret; | ||||
| +} | ||||
| + | ||||
| +static int rt_i2c_remove(struct platform_device *pdev) | ||||
| +{ | ||||
| +	struct rt_i2c *i2c = platform_get_drvdata(pdev); | ||||
| + | ||||
| +	i2c_del_adapter(&i2c->adap); | ||||
| +	clk_disable_unprepare(i2c->clk); | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static struct platform_driver rt_i2c_driver = { | ||||
| +	.probe		= rt_i2c_probe, | ||||
| +	.remove		= rt_i2c_remove, | ||||
| +	.driver		= { | ||||
| +		.owner	= THIS_MODULE, | ||||
| +		.name	= "i2c-ralink", | ||||
| +		.of_match_table = i2c_rt_dt_ids, | ||||
| +	}, | ||||
| +}; | ||||
| + | ||||
| +static int __init i2c_rt_init (void) | ||||
| +{ | ||||
| +	return platform_driver_register(&rt_i2c_driver); | ||||
| +} | ||||
| +subsys_initcall(i2c_rt_init); | ||||
| + | ||||
| +static void __exit i2c_rt_exit (void) | ||||
| +{ | ||||
| +	platform_driver_unregister(&rt_i2c_driver); | ||||
| +} | ||||
| +module_exit(i2c_rt_exit); | ||||
| + | ||||
| +MODULE_AUTHOR("Steven Liu <steven_liu@mediatek.com>"); | ||||
| +MODULE_DESCRIPTION("Ralink I2c host driver"); | ||||
| +MODULE_LICENSE("GPL"); | ||||
| +MODULE_ALIAS("platform:Ralink-I2C"); | ||||
| @@ -0,0 +1,43 @@ | ||||
| From 23147af14531cbdada194b94120ef8774f46292d Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Thu, 13 Nov 2014 19:08:40 +0100 | ||||
| Subject: [PATCH 46/53] mmc: MIPS: ralink: add sdhci for mt7620a SoC | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  drivers/mmc/host/Kconfig             |    2 + | ||||
|  drivers/mmc/host/Makefile            |    1 + | ||||
|  drivers/mmc/host/mtk-mmc/Kconfig     |   16 + | ||||
|  drivers/mmc/host/mtk-mmc/Makefile    |   42 + | ||||
|  drivers/mmc/host/mtk-mmc/board.h     |  137 ++ | ||||
|  drivers/mmc/host/mtk-mmc/dbg.c       |  347 ++++ | ||||
|  drivers/mmc/host/mtk-mmc/dbg.h       |  156 ++ | ||||
|  drivers/mmc/host/mtk-mmc/mt6575_sd.h | 1001 +++++++++++ | ||||
|  drivers/mmc/host/mtk-mmc/sd.c        | 3060 ++++++++++++++++++++++++++++++++++ | ||||
|  9 files changed, 4762 insertions(+) | ||||
|  create mode 100644 drivers/mmc/host/mtk-mmc/Kconfig | ||||
|  create mode 100644 drivers/mmc/host/mtk-mmc/Makefile | ||||
|  create mode 100644 drivers/mmc/host/mtk-mmc/board.h | ||||
|  create mode 100644 drivers/mmc/host/mtk-mmc/dbg.c | ||||
|  create mode 100644 drivers/mmc/host/mtk-mmc/dbg.h | ||||
|  create mode 100644 drivers/mmc/host/mtk-mmc/mt6575_sd.h | ||||
|  create mode 100644 drivers/mmc/host/mtk-mmc/sd.c | ||||
|  | ||||
| --- a/drivers/mmc/host/Kconfig | ||||
| +++ b/drivers/mmc/host/Kconfig | ||||
| @@ -1019,3 +1019,5 @@ config MMC_SDHCI_AM654 | ||||
|  	  If you have a controller with this interface, say Y or M here. | ||||
|   | ||||
|  	  If unsure, say N. | ||||
| + | ||||
| +source "drivers/mmc/host/mtk-mmc/Kconfig" | ||||
| --- a/drivers/mmc/host/Makefile | ||||
| +++ b/drivers/mmc/host/Makefile | ||||
| @@ -3,6 +3,7 @@ | ||||
|  # Makefile for MMC/SD host controller drivers | ||||
|  # | ||||
|   | ||||
| +obj-$(CONFIG_MTK_MMC) 		+= mtk-mmc/ | ||||
|  obj-$(CONFIG_MMC_ARMMMCI) += armmmci.o | ||||
|  armmmci-y := mmci.o | ||||
|  armmmci-$(CONFIG_MMC_QCOM_DML) += mmci_qcom_dml.o | ||||
							
								
								
									
										1046
									
								
								target/linux/ramips/patches-5.10/0048-asoc-add-mt7620-support.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										1046
									
								
								target/linux/ramips/patches-5.10/0048-asoc-add-mt7620-support.patch
									
									
									
									
									
										Normal file
									
								
							
										
											
												File diff suppressed because it is too large
												Load Diff
											
										
									
								
							| @@ -0,0 +1,22 @@ | ||||
| From a7eb46e0ea4a11e4dfb56ab129bf816d1059a6c5 Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Mon, 7 Dec 2015 17:31:08 +0100 | ||||
| Subject: [PATCH 51/53] serial: add ugly custom baud rate hack | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  drivers/tty/serial/serial_core.c |    3 +++ | ||||
|  1 file changed, 3 insertions(+) | ||||
|  | ||||
| --- a/drivers/tty/serial/serial_core.c | ||||
| +++ b/drivers/tty/serial/serial_core.c | ||||
| @@ -416,6 +416,9 @@ uart_get_baud_rate(struct uart_port *por | ||||
|  		break; | ||||
|  	} | ||||
|   | ||||
| +	if (tty_termios_baud_rate(termios) == 2500000) | ||||
| +		return 250000; | ||||
| + | ||||
|  	for (try = 0; try < 2; try++) { | ||||
|  		baud = tty_termios_baud_rate(termios); | ||||
|   | ||||
| @@ -0,0 +1,217 @@ | ||||
| From fc8f96309c21c1bc3276427309cd7d361347d66e Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Mon, 7 Dec 2015 17:16:50 +0100 | ||||
| Subject: [PATCH 52/53] pwm: add mediatek support | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  drivers/pwm/Kconfig        |    9 +++ | ||||
|  drivers/pwm/Makefile       |    1 + | ||||
|  drivers/pwm/pwm-mediatek.c |  173 ++++++++++++++++++++++++++++++++++++++++++++ | ||||
|  3 files changed, 183 insertions(+) | ||||
|  create mode 100644 drivers/pwm/pwm-mediatek.c | ||||
|  | ||||
| --- a/drivers/pwm/Kconfig | ||||
| +++ b/drivers/pwm/Kconfig | ||||
| @@ -316,6 +316,15 @@ config PWM_MEDIATEK | ||||
|  	  To compile this driver as a module, choose M here: the module | ||||
|  	  will be called pwm-mediatek. | ||||
|   | ||||
| +config PWM_MEDIATEK_RAMIPS | ||||
| +	tristate "Mediatek PWM support" | ||||
| +	depends on RALINK && OF | ||||
| +	help | ||||
| +	  Generic PWM framework driver for Mediatek ARM SoC. | ||||
| + | ||||
| +	  To compile this driver as a module, choose M here: the module | ||||
| +	  will be called pwm-mxs. | ||||
| + | ||||
|  config PWM_MXS | ||||
|  	tristate "Freescale MXS PWM support" | ||||
|  	depends on ARCH_MXS && OF | ||||
| --- a/drivers/pwm/Makefile | ||||
| +++ b/drivers/pwm/Makefile | ||||
| @@ -29,6 +29,7 @@ obj-$(CONFIG_PWM_LPSS_PCI)	+= pwm-lpss-p | ||||
|  obj-$(CONFIG_PWM_LPSS_PLATFORM)	+= pwm-lpss-platform.o | ||||
|  obj-$(CONFIG_PWM_MESON)		+= pwm-meson.o | ||||
|  obj-$(CONFIG_PWM_MEDIATEK)	+= pwm-mediatek.o | ||||
| +obj-$(CONFIG_PWM_MEDIATEK_RAMIPS)	+= pwm-mediatek-ramips.o | ||||
|  obj-$(CONFIG_PWM_MTK_DISP)	+= pwm-mtk-disp.o | ||||
|  obj-$(CONFIG_PWM_MXS)		+= pwm-mxs.o | ||||
|  obj-$(CONFIG_PWM_OMAP_DMTIMER)	+= pwm-omap-dmtimer.o | ||||
| --- /dev/null | ||||
| +++ b/drivers/pwm/pwm-mediatek-ramips.c | ||||
| @@ -0,0 +1,173 @@ | ||||
| +/* | ||||
| + * Mediatek Pulse Width Modulator driver | ||||
| + * | ||||
| + * Copyright (C) 2015 John Crispin <blogic@openwrt.org> | ||||
| + * | ||||
| + * This file is licensed under the terms of the GNU General Public | ||||
| + * License version 2. This program is licensed "as is" without any | ||||
| + * warranty of any kind, whether express or implied. | ||||
| + */ | ||||
| + | ||||
| +#include <linux/err.h> | ||||
| +#include <linux/io.h> | ||||
| +#include <linux/ioport.h> | ||||
| +#include <linux/kernel.h> | ||||
| +#include <linux/module.h> | ||||
| +#include <linux/of.h> | ||||
| +#include <linux/platform_device.h> | ||||
| +#include <linux/pwm.h> | ||||
| +#include <linux/slab.h> | ||||
| +#include <linux/types.h> | ||||
| + | ||||
| +#define NUM_PWM		4 | ||||
| + | ||||
| +/* PWM registers and bits definitions */ | ||||
| +#define PWMCON			0x00 | ||||
| +#define PWMHDUR			0x04 | ||||
| +#define PWMLDUR			0x08 | ||||
| +#define PWMGDUR			0x0c | ||||
| +#define PWMWAVENUM		0x28 | ||||
| +#define PWMDWIDTH		0x2c | ||||
| +#define PWMTHRES		0x30 | ||||
| + | ||||
| +/** | ||||
| + * struct mtk_pwm_chip - struct representing pwm chip | ||||
| + * | ||||
| + * @mmio_base: base address of pwm chip | ||||
| + * @chip: linux pwm chip representation | ||||
| + */ | ||||
| +struct mtk_pwm_chip { | ||||
| +	void __iomem *mmio_base; | ||||
| +	struct pwm_chip chip; | ||||
| +}; | ||||
| + | ||||
| +static inline struct mtk_pwm_chip *to_mtk_pwm_chip(struct pwm_chip *chip) | ||||
| +{ | ||||
| +	return container_of(chip, struct mtk_pwm_chip, chip); | ||||
| +} | ||||
| + | ||||
| +static inline u32 mtk_pwm_readl(struct mtk_pwm_chip *chip, unsigned int num, | ||||
| +				  unsigned long offset) | ||||
| +{ | ||||
| +	return ioread32(chip->mmio_base + 0x10 + (num * 0x40) + offset); | ||||
| +} | ||||
| + | ||||
| +static inline void mtk_pwm_writel(struct mtk_pwm_chip *chip, | ||||
| +				    unsigned int num, unsigned long offset, | ||||
| +				    unsigned long val) | ||||
| +{ | ||||
| +	iowrite32(val, chip->mmio_base + 0x10 + (num * 0x40) + offset); | ||||
| +} | ||||
| + | ||||
| +static int mtk_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm, | ||||
| +			    int duty_ns, int period_ns) | ||||
| +{ | ||||
| +	struct mtk_pwm_chip *pc = to_mtk_pwm_chip(chip); | ||||
| +	u32 resolution = 100 / 4; | ||||
| +	u32 clkdiv = 0; | ||||
| + | ||||
| +	while (period_ns / resolution  > 8191) { | ||||
| +		clkdiv++; | ||||
| +		resolution *= 2; | ||||
| +	} | ||||
| + | ||||
| +	if (clkdiv > 7) | ||||
| +		return -1; | ||||
| + | ||||
| +	mtk_pwm_writel(pc, pwm->hwpwm, PWMCON, BIT(15) | BIT(3) | clkdiv); | ||||
| +	mtk_pwm_writel(pc, pwm->hwpwm, PWMDWIDTH, period_ns / resolution); | ||||
| +	mtk_pwm_writel(pc, pwm->hwpwm, PWMTHRES, duty_ns / resolution); | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static int mtk_pwm_enable(struct pwm_chip *chip, struct pwm_device *pwm) | ||||
| +{ | ||||
| +	struct mtk_pwm_chip *pc = to_mtk_pwm_chip(chip); | ||||
| +	u32 val; | ||||
| + | ||||
| +	val = ioread32(pc->mmio_base); | ||||
| +	val |= BIT(pwm->hwpwm); | ||||
| +	iowrite32(val, pc->mmio_base); | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static void mtk_pwm_disable(struct pwm_chip *chip, struct pwm_device *pwm) | ||||
| +{ | ||||
| +	struct mtk_pwm_chip *pc = to_mtk_pwm_chip(chip); | ||||
| +	u32 val; | ||||
| + | ||||
| +	val = ioread32(pc->mmio_base); | ||||
| +	val &= ~BIT(pwm->hwpwm); | ||||
| +	iowrite32(val, pc->mmio_base); | ||||
| +} | ||||
| + | ||||
| +static const struct pwm_ops mtk_pwm_ops = { | ||||
| +	.config = mtk_pwm_config, | ||||
| +	.enable = mtk_pwm_enable, | ||||
| +	.disable = mtk_pwm_disable, | ||||
| +	.owner = THIS_MODULE, | ||||
| +}; | ||||
| + | ||||
| +static int mtk_pwm_probe(struct platform_device *pdev) | ||||
| +{ | ||||
| +	struct mtk_pwm_chip *pc; | ||||
| +	struct resource *r; | ||||
| +	int ret; | ||||
| + | ||||
| +	pc = devm_kzalloc(&pdev->dev, sizeof(*pc), GFP_KERNEL); | ||||
| +	if (!pc) | ||||
| +		return -ENOMEM; | ||||
| + | ||||
| +	r = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||||
| +	pc->mmio_base = devm_ioremap_resource(&pdev->dev, r); | ||||
| +	if (IS_ERR(pc->mmio_base)) | ||||
| +		return PTR_ERR(pc->mmio_base); | ||||
| + | ||||
| +	platform_set_drvdata(pdev, pc); | ||||
| + | ||||
| +	pc->chip.dev = &pdev->dev; | ||||
| +	pc->chip.ops = &mtk_pwm_ops; | ||||
| +	pc->chip.base = -1; | ||||
| +	pc->chip.npwm = NUM_PWM; | ||||
| + | ||||
| +	ret = pwmchip_add(&pc->chip); | ||||
| +	if (ret < 0) | ||||
| +		dev_err(&pdev->dev, "pwmchip_add() failed: %d\n", ret); | ||||
| + | ||||
| +	return ret; | ||||
| +} | ||||
| + | ||||
| +static int mtk_pwm_remove(struct platform_device *pdev) | ||||
| +{ | ||||
| +	struct mtk_pwm_chip *pc = platform_get_drvdata(pdev); | ||||
| +	int i; | ||||
| + | ||||
| +	for (i = 0; i < NUM_PWM; i++) | ||||
| +		pwm_disable(&pc->chip.pwms[i]); | ||||
| + | ||||
| +	return pwmchip_remove(&pc->chip); | ||||
| +} | ||||
| + | ||||
| +static const struct of_device_id mtk_pwm_of_match[] = { | ||||
| +	{ .compatible = "mediatek,mt7628-pwm" }, | ||||
| +	{ } | ||||
| +}; | ||||
| + | ||||
| +MODULE_DEVICE_TABLE(of, mtk_pwm_of_match); | ||||
| + | ||||
| +static struct platform_driver mtk_pwm_driver = { | ||||
| +	.driver = { | ||||
| +		.name = "mtk-pwm", | ||||
| +		.owner = THIS_MODULE, | ||||
| +		.of_match_table = mtk_pwm_of_match, | ||||
| +	}, | ||||
| +	.probe = mtk_pwm_probe, | ||||
| +	.remove = mtk_pwm_remove, | ||||
| +}; | ||||
| + | ||||
| +module_platform_driver(mtk_pwm_driver); | ||||
| + | ||||
| +MODULE_LICENSE("GPL"); | ||||
| +MODULE_AUTHOR("John Crispin <blogic@openwrt.org>"); | ||||
| +MODULE_ALIAS("platform:mtk-pwm"); | ||||
| @@ -0,0 +1,15 @@ | ||||
| --- a/drivers/usb/dwc2/platform.c | ||||
| +++ b/drivers/usb/dwc2/platform.c | ||||
| @@ -431,6 +431,12 @@ static int dwc2_driver_probe(struct plat | ||||
|  	if (retval) | ||||
|  		return retval; | ||||
|   | ||||
| +	/* Enable USB port before any regs access */ | ||||
| +	if (readl(hsotg->regs + PCGCTL) & 0x0f) { | ||||
| +		writel(0x00, hsotg->regs + PCGCTL); | ||||
| +		/* TODO: mdelay(25) here? vendor driver don't use it */ | ||||
| +	} | ||||
| + | ||||
|  	hsotg->needs_byte_swap = dwc2_check_core_endianness(hsotg); | ||||
|   | ||||
|  	retval = dwc2_get_dr_mode(hsotg); | ||||
							
								
								
									
										10
									
								
								target/linux/ramips/patches-5.10/0070-weak_reordering.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										10
									
								
								target/linux/ramips/patches-5.10/0070-weak_reordering.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,10 @@ | ||||
| --- a/arch/mips/ralink/Kconfig | ||||
| +++ b/arch/mips/ralink/Kconfig | ||||
| @@ -57,6 +57,7 @@ choice | ||||
|  		select COMMON_CLK | ||||
|  		select CLKSRC_MIPS_GIC | ||||
|  		select HAVE_PCI if PCI_MT7621 | ||||
| +		select WEAK_REORDERING_BEYOND_LLSC | ||||
|  endchoice | ||||
|   | ||||
|  choice | ||||
							
								
								
									
										19
									
								
								target/linux/ramips/patches-5.10/0098-disable_cm.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										19
									
								
								target/linux/ramips/patches-5.10/0098-disable_cm.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,19 @@ | ||||
| --- a/arch/mips/kernel/mips-cm.c | ||||
| +++ b/arch/mips/kernel/mips-cm.c | ||||
| @@ -233,6 +233,7 @@ int mips_cm_probe(void) | ||||
|   | ||||
|  	/* disable CM regions */ | ||||
|  	write_gcr_reg0_base(CM_GCR_REGn_BASE_BASEADDR); | ||||
| +	/* | ||||
|  	write_gcr_reg0_mask(CM_GCR_REGn_MASK_ADDRMASK); | ||||
|  	write_gcr_reg1_base(CM_GCR_REGn_BASE_BASEADDR); | ||||
|  	write_gcr_reg1_mask(CM_GCR_REGn_MASK_ADDRMASK); | ||||
| @@ -240,7 +241,7 @@ int mips_cm_probe(void) | ||||
|  	write_gcr_reg2_mask(CM_GCR_REGn_MASK_ADDRMASK); | ||||
|  	write_gcr_reg3_base(CM_GCR_REGn_BASE_BASEADDR); | ||||
|  	write_gcr_reg3_mask(CM_GCR_REGn_MASK_ADDRMASK); | ||||
| - | ||||
| +*/ | ||||
|  	/* probe for an L2-only sync region */ | ||||
|  	mips_cm_probe_l2sync(); | ||||
|   | ||||
| @@ -0,0 +1,133 @@ | ||||
| From b327cd58c3fec1c6382128e929eab9bc0d68e912 Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Sun, 8 Mar 2020 10:19:27 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: simplify | ||||
|  'mt7621_pcie_init_virtual_bridges' function | ||||
|  | ||||
| Function 'mt7621_pcie_init_virtual_bridges' is a bit mess and can be | ||||
| refactorized properly in a cleaner way. Introduce new 'pcie_rmw' inline | ||||
| function helper to do clear and set the correct bits this function needs | ||||
| to work. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200308091928.17177-1-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 85 +++++++++++++-------------------- | ||||
|  1 file changed, 33 insertions(+), 52 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -57,13 +57,13 @@ | ||||
|  #define RALINK_PCI_IOBASE		0x002C | ||||
|   | ||||
|  /* PCICFG virtual bridges */ | ||||
| -#define MT7621_BR0_MASK			GENMASK(19, 16) | ||||
| -#define MT7621_BR1_MASK			GENMASK(23, 20) | ||||
| -#define MT7621_BR2_MASK			GENMASK(27, 24) | ||||
| -#define MT7621_BR_ALL_MASK		GENMASK(27, 16) | ||||
| -#define MT7621_BR0_SHIFT		16 | ||||
| -#define MT7621_BR1_SHIFT		20 | ||||
| -#define MT7621_BR2_SHIFT		24 | ||||
| +#define PCIE_P2P_MAX			3 | ||||
| +#define PCIE_P2P_BR_DEVNUM_SHIFT(p)	(16 + (p) * 4) | ||||
| +#define PCIE_P2P_BR_DEVNUM0_SHIFT	PCIE_P2P_BR_DEVNUM_SHIFT(0) | ||||
| +#define PCIE_P2P_BR_DEVNUM1_SHIFT	PCIE_P2P_BR_DEVNUM_SHIFT(1) | ||||
| +#define PCIE_P2P_BR_DEVNUM2_SHIFT	PCIE_P2P_BR_DEVNUM_SHIFT(2) | ||||
| +#define PCIE_P2P_BR_DEVNUM_MASK		0xf | ||||
| +#define PCIE_P2P_BR_DEVNUM_MASK_FULL	(0xfff << PCIE_P2P_BR_DEVNUM0_SHIFT) | ||||
|   | ||||
|  /* PCIe RC control registers */ | ||||
|  #define MT7621_PCIE_OFFSET		0x2000 | ||||
| @@ -154,6 +154,15 @@ static inline void pcie_write(struct mt7 | ||||
|  	writel(val, pcie->base + reg); | ||||
|  } | ||||
|   | ||||
| +static inline void pcie_rmw(struct mt7621_pcie *pcie, u32 reg, u32 clr, u32 set) | ||||
| +{ | ||||
| +	u32 val = readl(pcie->base + reg); | ||||
| + | ||||
| +	val &= ~clr; | ||||
| +	val |= set; | ||||
| +	writel(val, pcie->base + reg); | ||||
| +} | ||||
| + | ||||
|  static inline u32 pcie_port_read(struct mt7621_pcie_port *port, u32 reg) | ||||
|  { | ||||
|  	return readl(port->base + reg); | ||||
| @@ -554,7 +563,9 @@ static void mt7621_pcie_enable_ports(str | ||||
|  static int mt7621_pcie_init_virtual_bridges(struct mt7621_pcie *pcie) | ||||
|  { | ||||
|  	u32 pcie_link_status = 0; | ||||
| -	u32 val = 0; | ||||
| +	u32 n; | ||||
| +	int i; | ||||
| +	u32 p2p_br_devnum[PCIE_P2P_MAX]; | ||||
|  	struct mt7621_pcie_port *port; | ||||
|   | ||||
|  	list_for_each_entry(port, &pcie->ports, list) { | ||||
| @@ -567,50 +578,20 @@ static int mt7621_pcie_init_virtual_brid | ||||
|  	if (pcie_link_status == 0) | ||||
|  		return -1; | ||||
|   | ||||
| -	/* | ||||
| -	 * pcie(2/1/0) link status	pcie2_num	pcie1_num	pcie0_num | ||||
| -	 * 3'b000			x		x		x | ||||
| -	 * 3'b001			x		x		0 | ||||
| -	 * 3'b010			x		0		x | ||||
| -	 * 3'b011			x		1		0 | ||||
| -	 * 3'b100			0		x		x | ||||
| -	 * 3'b101			1		x		0 | ||||
| -	 * 3'b110			1		0		x | ||||
| -	 * 3'b111			2		1		0 | ||||
| -	 */ | ||||
| -	switch (pcie_link_status) { | ||||
| -	case 2: | ||||
| -		val = pcie_read(pcie, RALINK_PCI_PCICFG_ADDR); | ||||
| -		val &= ~(MT7621_BR0_MASK | MT7621_BR1_MASK); | ||||
| -		val |= 0x1 << MT7621_BR0_SHIFT; | ||||
| -		val |= 0x0 << MT7621_BR1_SHIFT; | ||||
| -		pcie_write(pcie, val, RALINK_PCI_PCICFG_ADDR); | ||||
| -		break; | ||||
| -	case 4: | ||||
| -		val = pcie_read(pcie, RALINK_PCI_PCICFG_ADDR); | ||||
| -		val &= ~MT7621_BR_ALL_MASK; | ||||
| -		val |= 0x1 << MT7621_BR0_SHIFT; | ||||
| -		val |= 0x2 << MT7621_BR1_SHIFT; | ||||
| -		val |= 0x0 << MT7621_BR2_SHIFT; | ||||
| -		pcie_write(pcie, val, RALINK_PCI_PCICFG_ADDR); | ||||
| -		break; | ||||
| -	case 5: | ||||
| -		val = pcie_read(pcie, RALINK_PCI_PCICFG_ADDR); | ||||
| -		val &= ~MT7621_BR_ALL_MASK; | ||||
| -		val |= 0x0 << MT7621_BR0_SHIFT; | ||||
| -		val |= 0x2 << MT7621_BR1_SHIFT; | ||||
| -		val |= 0x1 << MT7621_BR2_SHIFT; | ||||
| -		pcie_write(pcie, val, RALINK_PCI_PCICFG_ADDR); | ||||
| -		break; | ||||
| -	case 6: | ||||
| -		val = pcie_read(pcie, RALINK_PCI_PCICFG_ADDR); | ||||
| -		val &= ~MT7621_BR_ALL_MASK; | ||||
| -		val |= 0x2 << MT7621_BR0_SHIFT; | ||||
| -		val |= 0x0 << MT7621_BR1_SHIFT; | ||||
| -		val |= 0x1 << MT7621_BR2_SHIFT; | ||||
| -		pcie_write(pcie, val, RALINK_PCI_PCICFG_ADDR); | ||||
| -		break; | ||||
| -	} | ||||
| +	n = 0; | ||||
| +	for (i = 0; i < PCIE_P2P_MAX; i++) | ||||
| +		if (pcie_link_status & BIT(i)) | ||||
| +			p2p_br_devnum[i] = n++; | ||||
| + | ||||
| +	for (i = 0; i < PCIE_P2P_MAX; i++) | ||||
| +		if ((pcie_link_status & BIT(i)) == 0) | ||||
| +			p2p_br_devnum[i] = n++; | ||||
| + | ||||
| +	pcie_rmw(pcie, RALINK_PCI_CONFIG_ADDR, | ||||
| +		 PCIE_P2P_BR_DEVNUM_MASK_FULL, | ||||
| +		 (p2p_br_devnum[0] << PCIE_P2P_BR_DEVNUM0_SHIFT) | | ||||
| +		 (p2p_br_devnum[1] << PCIE_P2P_BR_DEVNUM1_SHIFT) | | ||||
| +		 (p2p_br_devnum[2] << PCIE_P2P_BR_DEVNUM2_SHIFT)); | ||||
|   | ||||
|  	return 0; | ||||
|  } | ||||
| @@ -0,0 +1,74 @@ | ||||
| From 550fabd71d7fcdfe099bbf41e00e28719737161e Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Tue, 10 Mar 2020 12:34:59 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: enable clock bit for each port | ||||
|  | ||||
| The clock related code concerns me from the very beginning because | ||||
| there are some set ups got from legacy driver that are not documented | ||||
| anywhere. According to the programming guide 0x7c is 'CPE_ROSC_SEL1' | ||||
| register and 0x80 is 'CPU_CPE_CN'. I do think this set up is not needed | ||||
| at all and the proper thing to do is just enable the clock bit for each | ||||
| pcie port. Hence remove useless code and do the right thing which is | ||||
| setting up the clock bit for each port enabled. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200310113459.30539-1-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 17 ++++++----------- | ||||
|  1 file changed, 6 insertions(+), 11 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -45,8 +45,6 @@ | ||||
|   | ||||
|  /* rt_sysc_membase relative registers */ | ||||
|  #define RALINK_CLKCFG1			0x30 | ||||
| -#define RALINK_PCIE_CLK_GEN		0x7c | ||||
| -#define RALINK_PCIE_CLK_GEN1		0x80 | ||||
|   | ||||
|  /* Host-PCI bridge registers */ | ||||
|  #define RALINK_PCI_PCICFG_ADDR		0x0000 | ||||
| @@ -85,10 +83,6 @@ | ||||
|  #define PCIE_PORT_CLK_EN(x)		BIT(24 + (x)) | ||||
|  #define PCIE_PORT_LINKUP		BIT(0) | ||||
|   | ||||
| -#define PCIE_CLK_GEN_EN			BIT(31) | ||||
| -#define PCIE_CLK_GEN_DIS		0 | ||||
| -#define PCIE_CLK_GEN1_DIS		GENMASK(30, 24) | ||||
| -#define PCIE_CLK_GEN1_EN		(BIT(27) | BIT(25)) | ||||
|  #define MEMORY_BASE			0x0 | ||||
|  #define PERST_MODE_MASK			GENMASK(11, 10) | ||||
|  #define PERST_MODE_GPIO			BIT(10) | ||||
| @@ -233,6 +227,11 @@ static inline bool mt7621_pcie_port_is_l | ||||
|  	return (pcie_port_read(port, RALINK_PCI_STATUS) & PCIE_PORT_LINKUP) != 0; | ||||
|  } | ||||
|   | ||||
| +static inline void mt7621_pcie_port_clk_enable(struct mt7621_pcie_port *port) | ||||
| +{ | ||||
| +	rt_sysc_m32(0, PCIE_PORT_CLK_EN(port->slot), RALINK_CLKCFG1); | ||||
| +} | ||||
| + | ||||
|  static inline void mt7621_pcie_port_clk_disable(struct mt7621_pcie_port *port) | ||||
|  { | ||||
|  	rt_sysc_m32(PCIE_PORT_CLK_EN(port->slot), 0, RALINK_CLKCFG1); | ||||
| @@ -501,11 +500,6 @@ static void mt7621_pcie_init_ports(struc | ||||
|  		} | ||||
|  	} | ||||
|   | ||||
| -	rt_sysc_m32(0x30, 2 << 4, SYSC_REG_SYSTEM_CONFIG1); | ||||
| -	rt_sysc_m32(PCIE_CLK_GEN_EN, PCIE_CLK_GEN_DIS, RALINK_PCIE_CLK_GEN); | ||||
| -	rt_sysc_m32(PCIE_CLK_GEN1_DIS, PCIE_CLK_GEN1_EN, RALINK_PCIE_CLK_GEN1); | ||||
| -	rt_sysc_m32(PCIE_CLK_GEN_DIS, PCIE_CLK_GEN_EN, RALINK_PCIE_CLK_GEN); | ||||
| -	msleep(50); | ||||
|  	reset_control_deassert(pcie->rst); | ||||
|  } | ||||
|   | ||||
| @@ -542,6 +536,7 @@ static void mt7621_pcie_enable_ports(str | ||||
|   | ||||
|  	list_for_each_entry(port, &pcie->ports, list) { | ||||
|  		if (port->enabled) { | ||||
| +			mt7621_pcie_port_clk_enable(port); | ||||
|  			mt7621_pcie_enable_port(port); | ||||
|  			dev_info(dev, "PCIE%d enabled\n", num_slots_enabled); | ||||
|  			num_slots_enabled++; | ||||
| @@ -0,0 +1,222 @@ | ||||
| From 227a8bf421ff8b085444e51e471ef06a87228cfd Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Fri, 13 Mar 2020 21:09:08 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: use gpios for properly reset | ||||
|  | ||||
| Original driver code was using three gpio's for reset | ||||
| asserts and deasserts the pcis. Instead of using that | ||||
| a general reset control with a perst gpio was introduced | ||||
| and it seems it is partially working but sometimes there | ||||
| are some unexpected hangs on boot. This commit make use of | ||||
| the three original gpios using 'reset-gpios' property of | ||||
| the device tree and removes the reset line and perst gpio. | ||||
| According to the mediatek aplication note v0.1 there are | ||||
| three gpios used for pcie ports reset control: gpio#19, | ||||
| gpio#8 and gpio#7 for slots 0, 1 and 2 respectively. | ||||
| This schema can be used separately for mt7621A but in some | ||||
| boards due to pin share issue, if the PCM and I2S function | ||||
| are enable at the same time, there are no enough GPIO to | ||||
| control per-port PCIe reset. In those cases gpio#19 is enought | ||||
| for reset the three ports together. Because of this we just | ||||
| try to get the three gpios but if some of them fail we are not | ||||
| failing in boot process, just prints a kernel notice and take | ||||
| after into account if the descriptor is or not valid in order | ||||
| to use it. All of them are set as GPIO output low configuration. | ||||
| The gpio descriptor's API takes device tree property into account | ||||
| and invert value if the pin is configured as active low. | ||||
| So we also have to properly request pins from device tree | ||||
| and set values correct in assert and deassert functions. | ||||
| After this changes the order to make all assert and | ||||
| deassert in the 'probe' process makes more sense: | ||||
| * Parse device tree. | ||||
| * make assert of the RC's and EP's before doing anything else. | ||||
| * make deassert of the RC's before initializing the phy. | ||||
| * Init the phy. | ||||
| * make deassert of the EP's before initialize pci ports. | ||||
| * Normal PCI initialization. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200313200913.24321-2-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 84 ++++++++++++++++++++------------- | ||||
|  1 file changed, 51 insertions(+), 33 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -95,6 +95,7 @@ | ||||
|   * @pcie: pointer to PCIe host info | ||||
|   * @phy: pointer to PHY control block | ||||
|   * @pcie_rst: pointer to port reset control | ||||
| + * @gpio_rst: gpio reset | ||||
|   * @slot: port slot | ||||
|   * @enabled: indicates if port is enabled | ||||
|   */ | ||||
| @@ -104,6 +105,7 @@ struct mt7621_pcie_port { | ||||
|  	struct mt7621_pcie *pcie; | ||||
|  	struct phy *phy; | ||||
|  	struct reset_control *pcie_rst; | ||||
| +	struct gpio_desc *gpio_rst; | ||||
|  	u32 slot; | ||||
|  	bool enabled; | ||||
|  }; | ||||
| @@ -117,8 +119,6 @@ struct mt7621_pcie_port { | ||||
|   * @offset: IO / Memory offset | ||||
|   * @dev: Pointer to PCIe device | ||||
|   * @ports: pointer to PCIe port information | ||||
| - * @perst: gpio reset | ||||
| - * @rst: pointer to pcie reset | ||||
|   * @resets_inverted: depends on chip revision | ||||
|   * reset lines are inverted. | ||||
|   */ | ||||
| @@ -133,8 +133,6 @@ struct mt7621_pcie { | ||||
|  		resource_size_t io; | ||||
|  	} offset; | ||||
|  	struct list_head ports; | ||||
| -	struct gpio_desc *perst; | ||||
| -	struct reset_control *rst; | ||||
|  	bool resets_inverted; | ||||
|  }; | ||||
|   | ||||
| @@ -210,16 +208,16 @@ static void write_config(struct mt7621_p | ||||
|  	pcie_write(pcie, val, RALINK_PCI_CONFIG_DATA); | ||||
|  } | ||||
|   | ||||
| -static inline void mt7621_perst_gpio_pcie_assert(struct mt7621_pcie *pcie) | ||||
| +static inline void mt7621_rst_gpio_pcie_assert(struct mt7621_pcie_port *port) | ||||
|  { | ||||
| -	gpiod_set_value(pcie->perst, 0); | ||||
| -	mdelay(PERST_DELAY_US); | ||||
| +	if (port->gpio_rst) | ||||
| +		gpiod_set_value(port->gpio_rst, 1); | ||||
|  } | ||||
|   | ||||
| -static inline void mt7621_perst_gpio_pcie_deassert(struct mt7621_pcie *pcie) | ||||
| +static inline void mt7621_rst_gpio_pcie_deassert(struct mt7621_pcie_port *port) | ||||
|  { | ||||
| -	gpiod_set_value(pcie->perst, 1); | ||||
| -	mdelay(PERST_DELAY_US); | ||||
| +	if (port->gpio_rst) | ||||
| +		gpiod_set_value(port->gpio_rst, 0); | ||||
|  } | ||||
|   | ||||
|  static inline bool mt7621_pcie_port_is_linkup(struct mt7621_pcie_port *port) | ||||
| @@ -367,6 +365,13 @@ static int mt7621_pcie_parse_port(struct | ||||
|  	if (IS_ERR(port->phy)) | ||||
|  		return PTR_ERR(port->phy); | ||||
|   | ||||
| +	port->gpio_rst = devm_gpiod_get_index_optional(dev, "reset", slot, | ||||
| +						       GPIOD_OUT_LOW); | ||||
| +	if (IS_ERR(port->gpio_rst)) { | ||||
| +		dev_err(dev, "Failed to get GPIO for PCIe%d\n", slot); | ||||
| +		return PTR_ERR(port->gpio_rst); | ||||
| +	} | ||||
| + | ||||
|  	port->slot = slot; | ||||
|  	port->pcie = pcie; | ||||
|   | ||||
| @@ -383,12 +388,6 @@ static int mt7621_pcie_parse_dt(struct m | ||||
|  	struct resource regs; | ||||
|  	int err; | ||||
|   | ||||
| -	pcie->perst = devm_gpiod_get(dev, "perst", GPIOD_OUT_HIGH); | ||||
| -	if (IS_ERR(pcie->perst)) { | ||||
| -		dev_err(dev, "failed to get gpio perst\n"); | ||||
| -		return PTR_ERR(pcie->perst); | ||||
| -	} | ||||
| - | ||||
|  	err = of_address_to_resource(node, 0, ®s); | ||||
|  	if (err) { | ||||
|  		dev_err(dev, "missing \"reg\" property\n"); | ||||
| @@ -399,12 +398,6 @@ static int mt7621_pcie_parse_dt(struct m | ||||
|  	if (IS_ERR(pcie->base)) | ||||
|  		return PTR_ERR(pcie->base); | ||||
|   | ||||
| -	pcie->rst = devm_reset_control_get_exclusive(dev, "pcie"); | ||||
| -	if (PTR_ERR(pcie->rst) == -EPROBE_DEFER) { | ||||
| -		dev_err(dev, "failed to get pcie reset control\n"); | ||||
| -		return PTR_ERR(pcie->rst); | ||||
| -	} | ||||
| - | ||||
|  	for_each_available_child_of_node(node, child) { | ||||
|  		int slot; | ||||
|   | ||||
| @@ -458,16 +451,49 @@ static int mt7621_pcie_init_port(struct | ||||
|  	return 0; | ||||
|  } | ||||
|   | ||||
| +static void mt7621_pcie_reset_assert(struct mt7621_pcie *pcie) | ||||
| +{ | ||||
| +	struct mt7621_pcie_port *port; | ||||
| + | ||||
| +	list_for_each_entry(port, &pcie->ports, list) { | ||||
| +		/* PCIe RC reset assert */ | ||||
| +		mt7621_control_assert(port); | ||||
| + | ||||
| +		/* PCIe EP reset assert */ | ||||
| +		mt7621_rst_gpio_pcie_assert(port); | ||||
| +	} | ||||
| + | ||||
| +	mdelay(PERST_DELAY_US); | ||||
| +} | ||||
| + | ||||
| +static void mt7621_pcie_reset_rc_deassert(struct mt7621_pcie *pcie) | ||||
| +{ | ||||
| +	struct mt7621_pcie_port *port; | ||||
| + | ||||
| +	list_for_each_entry(port, &pcie->ports, list) | ||||
| +		mt7621_control_deassert(port); | ||||
| +} | ||||
| + | ||||
| +static void mt7621_pcie_reset_ep_deassert(struct mt7621_pcie *pcie) | ||||
| +{ | ||||
| +	struct mt7621_pcie_port *port; | ||||
| + | ||||
| +	list_for_each_entry(port, &pcie->ports, list) | ||||
| +		mt7621_rst_gpio_pcie_deassert(port); | ||||
| + | ||||
| +	mdelay(PERST_DELAY_US); | ||||
| +} | ||||
| + | ||||
|  static void mt7621_pcie_init_ports(struct mt7621_pcie *pcie) | ||||
|  { | ||||
|  	struct device *dev = pcie->dev; | ||||
|  	struct mt7621_pcie_port *port, *tmp; | ||||
| -	u32 val = 0; | ||||
|  	int err; | ||||
|   | ||||
|  	rt_sysc_m32(PERST_MODE_MASK, PERST_MODE_GPIO, MT7621_GPIO_MODE); | ||||
|   | ||||
| -	mt7621_perst_gpio_pcie_assert(pcie); | ||||
| +	mt7621_pcie_reset_assert(pcie); | ||||
| +	mt7621_pcie_reset_rc_deassert(pcie); | ||||
|   | ||||
|  	list_for_each_entry_safe(port, tmp, &pcie->ports, list) { | ||||
|  		u32 slot = port->slot; | ||||
| @@ -476,16 +502,10 @@ static void mt7621_pcie_init_ports(struc | ||||
|  		if (err) { | ||||
|  			dev_err(dev, "Initiating port %d failed\n", slot); | ||||
|  			list_del(&port->list); | ||||
| -		} else { | ||||
| -			val = read_config(pcie, slot, PCIE_FTS_NUM); | ||||
| -			dev_info(dev, "Port %d N_FTS = %x\n", slot, | ||||
| -				 (unsigned int)val); | ||||
|  		} | ||||
|  	} | ||||
|   | ||||
| -	reset_control_assert(pcie->rst); | ||||
| - | ||||
| -	mt7621_perst_gpio_pcie_deassert(pcie); | ||||
| +	mt7621_pcie_reset_ep_deassert(pcie); | ||||
|   | ||||
|  	list_for_each_entry(port, &pcie->ports, list) { | ||||
|  		u32 slot = port->slot; | ||||
| @@ -499,8 +519,6 @@ static void mt7621_pcie_init_ports(struc | ||||
|  			port->enabled = false; | ||||
|  		} | ||||
|  	} | ||||
| - | ||||
| -	reset_control_deassert(pcie->rst); | ||||
|  } | ||||
|   | ||||
|  static void mt7621_pcie_enable_port(struct mt7621_pcie_port *port) | ||||
| @@ -0,0 +1,45 @@ | ||||
| From e462e7d3211479df42357a620fa788a2257556b7 Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Fri, 13 Mar 2020 21:09:09 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: change value for 'PERST_DELAY_MS' | ||||
|  | ||||
| Value of 'PERST_DELAY_MS' is too high and it is ok just | ||||
| to set up to 100 ms. Update also define name from | ||||
| 'PERST_DELAY_US' into 'PERST_DELAY_MS' | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200313200913.24321-3-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 6 +++--- | ||||
|  1 file changed, 3 insertions(+), 3 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -86,7 +86,7 @@ | ||||
|  #define MEMORY_BASE			0x0 | ||||
|  #define PERST_MODE_MASK			GENMASK(11, 10) | ||||
|  #define PERST_MODE_GPIO			BIT(10) | ||||
| -#define PERST_DELAY_US			1000 | ||||
| +#define PERST_DELAY_MS			100 | ||||
|   | ||||
|  /** | ||||
|   * struct mt7621_pcie_port - PCIe port information | ||||
| @@ -463,7 +463,7 @@ static void mt7621_pcie_reset_assert(str | ||||
|  		mt7621_rst_gpio_pcie_assert(port); | ||||
|  	} | ||||
|   | ||||
| -	mdelay(PERST_DELAY_US); | ||||
| +	mdelay(PERST_DELAY_MS); | ||||
|  } | ||||
|   | ||||
|  static void mt7621_pcie_reset_rc_deassert(struct mt7621_pcie *pcie) | ||||
| @@ -481,7 +481,7 @@ static void mt7621_pcie_reset_ep_deasser | ||||
|  	list_for_each_entry(port, &pcie->ports, list) | ||||
|  		mt7621_rst_gpio_pcie_deassert(port); | ||||
|   | ||||
| -	mdelay(PERST_DELAY_US); | ||||
| +	mdelay(PERST_DELAY_MS); | ||||
|  } | ||||
|   | ||||
|  static void mt7621_pcie_init_ports(struct mt7621_pcie *pcie) | ||||
| @@ -0,0 +1,76 @@ | ||||
| From 4d6a758f2cd2122a7d895f913854c13da62ba6df Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Fri, 13 Mar 2020 21:09:12 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: release gpios after pci initialization | ||||
|  | ||||
| R3G's LEDs fail to initialize because one of them uses GPIO8 | ||||
| Hence, release the GPIO resources after PCIe initialization | ||||
| and properly release also in driver error path. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200313200913.24321-6-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 23 ++++++++++++++++++----- | ||||
|  1 file changed, 18 insertions(+), 5 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -484,6 +484,15 @@ static void mt7621_pcie_reset_ep_deasser | ||||
|  	mdelay(PERST_DELAY_MS); | ||||
|  } | ||||
|   | ||||
| +static void mt7621_pcie_release_gpios(struct mt7621_pcie *pcie) | ||||
| +{ | ||||
| +	struct mt7621_pcie_port *port; | ||||
| + | ||||
| +	list_for_each_entry(port, &pcie->ports, list) | ||||
| +		if (port->gpio_rst) | ||||
| +			gpiod_put(port->gpio_rst); | ||||
| +} | ||||
| + | ||||
|  static void mt7621_pcie_init_ports(struct mt7621_pcie *pcie) | ||||
|  { | ||||
|  	struct device *dev = pcie->dev; | ||||
| @@ -683,7 +692,8 @@ static int mt7621_pci_probe(struct platf | ||||
|  	err = mt7621_pcie_init_virtual_bridges(pcie); | ||||
|  	if (err) { | ||||
|  		dev_err(dev, "Nothing is connected in virtual bridges. Exiting..."); | ||||
| -		return 0; | ||||
| +		err = 0; | ||||
| +		goto out_release_gpios; | ||||
|  	} | ||||
|   | ||||
|  	mt7621_pcie_enable_ports(pcie); | ||||
| @@ -691,7 +701,7 @@ static int mt7621_pci_probe(struct platf | ||||
|  	err = mt7621_pci_parse_request_of_pci_ranges(pcie); | ||||
|  	if (err) { | ||||
|  		dev_err(dev, "Error requesting pci resources from ranges"); | ||||
| -		return err; | ||||
| +		goto out_release_gpios; | ||||
|  	} | ||||
|   | ||||
|  	setup_cm_memory_region(pcie); | ||||
| @@ -699,16 +709,19 @@ static int mt7621_pci_probe(struct platf | ||||
|  	err = mt7621_pcie_request_resources(pcie, &res); | ||||
|  	if (err) { | ||||
|  		dev_err(dev, "Error requesting resources\n"); | ||||
| -		return err; | ||||
| +		goto out_release_gpios; | ||||
|  	} | ||||
|   | ||||
|  	err = mt7621_pcie_register_host(bridge, &res); | ||||
|  	if (err) { | ||||
|  		dev_err(dev, "Error registering host\n"); | ||||
| -		return err; | ||||
| +		goto out_release_gpios; | ||||
|  	} | ||||
|   | ||||
| -	return 0; | ||||
| +out_release_gpios: | ||||
| +	mt7621_pcie_release_gpios(pcie); | ||||
| + | ||||
| +	return err; | ||||
|  } | ||||
|   | ||||
|  static const struct of_device_id mt7621_pci_ids[] = { | ||||
| @@ -0,0 +1,46 @@ | ||||
| From 4be54c3a495f08c05a8e485566e5b88cd3537f16 Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Fri, 13 Mar 2020 21:09:13 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: delete no more needed | ||||
|  'mt7621_reset_port' | ||||
|  | ||||
| After review all the resets at the beggining the function | ||||
| 'mt7621_reset_port' is not needed anymore. Hence delete it | ||||
| and its uses. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200313200913.24321-7-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 13 ------------- | ||||
|  1 file changed, 13 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -255,13 +255,6 @@ static inline void mt7621_control_deasse | ||||
|  		reset_control_assert(port->pcie_rst); | ||||
|  } | ||||
|   | ||||
| -static void mt7621_reset_port(struct mt7621_pcie_port *port) | ||||
| -{ | ||||
| -	mt7621_control_assert(port); | ||||
| -	msleep(100); | ||||
| -	mt7621_control_deassert(port); | ||||
| -} | ||||
| - | ||||
|  static void setup_cm_memory_region(struct mt7621_pcie *pcie) | ||||
|  { | ||||
|  	struct resource *mem_resource = &pcie->mem; | ||||
| @@ -427,12 +420,6 @@ static int mt7621_pcie_init_port(struct | ||||
|  	u32 slot = port->slot; | ||||
|  	int err; | ||||
|   | ||||
| -	/* | ||||
| -	 * Any MT7621 Ralink pcie controller that doesn't have 0x0101 at | ||||
| -	 * the end of the chip_id has inverted PCI resets. | ||||
| -	 */ | ||||
| -	mt7621_reset_port(port); | ||||
| - | ||||
|  	err = phy_init(port->phy); | ||||
|  	if (err) { | ||||
|  		dev_err(dev, "failed to initialize port%d phy\n", slot); | ||||
| @@ -0,0 +1,234 @@ | ||||
| From bf0c6782e5b9a6deee4e223655325dc004fae8dd Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Sun, 15 Mar 2020 17:01:54 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci-phy: add 'mt7621_phy_rmw' to simplify | ||||
|  code | ||||
|  | ||||
| In order to simplify driver code and decrease a bit LOC add new | ||||
| function 'mt7621_phy_rmw' where clear and set bits are passed as | ||||
| arguments. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200315160154.10292-1-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci-phy/pci-mt7621-phy.c | 158 +++++++++++------------- | ||||
|  1 file changed, 71 insertions(+), 87 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci-phy/pci-mt7621-phy.c | ||||
| +++ b/drivers/staging/mt7621-pci-phy/pci-mt7621-phy.c | ||||
| @@ -120,17 +120,25 @@ static inline void phy_write(struct mt76 | ||||
|  	regmap_write(phy->regmap, reg, val); | ||||
|  } | ||||
|   | ||||
| +static inline void mt7621_phy_rmw(struct mt7621_pci_phy *phy, | ||||
| +				  u32 reg, u32 clr, u32 set) | ||||
| +{ | ||||
| +	u32 val = phy_read(phy, reg); | ||||
| + | ||||
| +	val &= ~clr; | ||||
| +	val |= set; | ||||
| +	phy_write(phy, val, reg); | ||||
| +} | ||||
| + | ||||
|  static void mt7621_bypass_pipe_rst(struct mt7621_pci_phy *phy, | ||||
|  				   struct mt7621_pci_phy_instance *instance) | ||||
|  { | ||||
|  	u32 offset = (instance->index != 1) ? | ||||
|  		RG_PE1_PIPE_REG : RG_PE1_PIPE_REG + RG_P0_TO_P1_WIDTH; | ||||
| -	u32 reg; | ||||
|   | ||||
| -	reg = phy_read(phy, offset); | ||||
| -	reg &= ~(RG_PE1_PIPE_RST | RG_PE1_PIPE_CMD_FRC); | ||||
| -	reg |= (RG_PE1_PIPE_RST | RG_PE1_PIPE_CMD_FRC); | ||||
| -	phy_write(phy, reg, offset); | ||||
| +	mt7621_phy_rmw(phy, offset, | ||||
| +		       RG_PE1_PIPE_RST | RG_PE1_PIPE_CMD_FRC, | ||||
| +		       RG_PE1_PIPE_RST | RG_PE1_PIPE_CMD_FRC); | ||||
|  } | ||||
|   | ||||
|  static void mt7621_set_phy_for_ssc(struct mt7621_pci_phy *phy, | ||||
| @@ -139,97 +147,77 @@ static void mt7621_set_phy_for_ssc(struc | ||||
|  	struct device *dev = phy->dev; | ||||
|  	u32 reg = rt_sysc_r32(SYSC_REG_SYSTEM_CONFIG0); | ||||
|  	u32 offset; | ||||
| -	u32 val; | ||||
|   | ||||
|  	reg = (reg >> 6) & 0x7; | ||||
|  	/* Set PCIe Port PHY to disable SSC */ | ||||
|  	/* Debug Xtal Type */ | ||||
| -	val = phy_read(phy, RG_PE1_FRC_H_XTAL_REG); | ||||
| -	val &= ~(RG_PE1_FRC_H_XTAL_TYPE | RG_PE1_H_XTAL_TYPE); | ||||
| -	val |= RG_PE1_FRC_H_XTAL_TYPE; | ||||
| -	val |= RG_PE1_H_XTAL_TYPE_VAL(0x00); | ||||
| -	phy_write(phy, val, RG_PE1_FRC_H_XTAL_REG); | ||||
| +	mt7621_phy_rmw(phy, RG_PE1_FRC_H_XTAL_REG, | ||||
| +		       RG_PE1_FRC_H_XTAL_TYPE | RG_PE1_H_XTAL_TYPE, | ||||
| +		       RG_PE1_FRC_H_XTAL_TYPE | RG_PE1_H_XTAL_TYPE_VAL(0x00)); | ||||
|   | ||||
|  	/* disable port */ | ||||
|  	offset = (instance->index != 1) ? | ||||
|  		RG_PE1_FRC_PHY_REG : RG_PE1_FRC_PHY_REG + RG_P0_TO_P1_WIDTH; | ||||
| -	val = phy_read(phy, offset); | ||||
| -	val &= ~(RG_PE1_FRC_PHY_EN | RG_PE1_PHY_EN); | ||||
| -	val |= RG_PE1_FRC_PHY_EN; | ||||
| -	phy_write(phy, val, offset); | ||||
| - | ||||
| -	/* Set Pre-divider ratio (for host mode) */ | ||||
| -	val = phy_read(phy, RG_PE1_H_PLL_REG); | ||||
| -	val &= ~(RG_PE1_H_PLL_PREDIV); | ||||
| +	mt7621_phy_rmw(phy, offset, | ||||
| +		       RG_PE1_FRC_PHY_EN | RG_PE1_PHY_EN, RG_PE1_FRC_PHY_EN); | ||||
|   | ||||
|  	if (reg <= 5 && reg >= 3) { /* 40MHz Xtal */ | ||||
| -		val |= RG_PE1_H_PLL_PREDIV_VAL(0x01); | ||||
| -		phy_write(phy, val, RG_PE1_H_PLL_REG); | ||||
| +		/* Set Pre-divider ratio (for host mode) */ | ||||
| +		mt7621_phy_rmw(phy, RG_PE1_H_PLL_REG, | ||||
| +			       RG_PE1_H_PLL_PREDIV, | ||||
| +			       RG_PE1_H_PLL_PREDIV_VAL(0x01)); | ||||
|  		dev_info(dev, "Xtal is 40MHz\n"); | ||||
| -	} else { /* 25MHz | 20MHz Xtal */ | ||||
| -		val |= RG_PE1_H_PLL_PREDIV_VAL(0x00); | ||||
| -		phy_write(phy, val, RG_PE1_H_PLL_REG); | ||||
| -		if (reg >= 6) { | ||||
| -			dev_info(dev, "Xtal is 25MHz\n"); | ||||
| - | ||||
| -			/* Select feedback clock */ | ||||
| -			val = phy_read(phy, RG_PE1_H_PLL_FBKSEL_REG); | ||||
| -			val &= ~(RG_PE1_H_PLL_FBKSEL); | ||||
| -			val |= RG_PE1_H_PLL_FBKSEL_VAL(0x01); | ||||
| -			phy_write(phy, val, RG_PE1_H_PLL_FBKSEL_REG); | ||||
| - | ||||
| -			/* DDS NCPO PCW (for host mode) */ | ||||
| -			val = phy_read(phy, RG_PE1_H_LCDDS_SSC_PRD_REG); | ||||
| -			val &= ~(RG_PE1_H_LCDDS_SSC_PRD); | ||||
| -			val |= RG_PE1_H_LCDDS_SSC_PRD_VAL(0x18000000); | ||||
| -			phy_write(phy, val, RG_PE1_H_LCDDS_SSC_PRD_REG); | ||||
| - | ||||
| -			/* DDS SSC dither period control */ | ||||
| -			val = phy_read(phy, RG_PE1_H_LCDDS_SSC_PRD_REG); | ||||
| -			val &= ~(RG_PE1_H_LCDDS_SSC_PRD); | ||||
| -			val |= RG_PE1_H_LCDDS_SSC_PRD_VAL(0x18d); | ||||
| -			phy_write(phy, val, RG_PE1_H_LCDDS_SSC_PRD_REG); | ||||
| - | ||||
| -			/* DDS SSC dither amplitude control */ | ||||
| -			val = phy_read(phy, RG_PE1_H_LCDDS_SSC_DELTA_REG); | ||||
| -			val &= ~(RG_PE1_H_LCDDS_SSC_DELTA | | ||||
| -				 RG_PE1_H_LCDDS_SSC_DELTA1); | ||||
| -			val |= RG_PE1_H_LCDDS_SSC_DELTA_VAL(0x4a); | ||||
| -			val |= RG_PE1_H_LCDDS_SSC_DELTA1_VAL(0x4a); | ||||
| -			phy_write(phy, val, RG_PE1_H_LCDDS_SSC_DELTA_REG); | ||||
| -		} else { | ||||
| -			dev_info(dev, "Xtal is 20MHz\n"); | ||||
| -		} | ||||
| +	} else if (reg >= 6) { /* 25MHz Xal */ | ||||
| +		mt7621_phy_rmw(phy, RG_PE1_H_PLL_REG, | ||||
| +			       RG_PE1_H_PLL_PREDIV, | ||||
| +			       RG_PE1_H_PLL_PREDIV_VAL(0x00)); | ||||
| +		/* Select feedback clock */ | ||||
| +		mt7621_phy_rmw(phy, RG_PE1_H_PLL_FBKSEL_REG, | ||||
| +			       RG_PE1_H_PLL_FBKSEL, | ||||
| +			       RG_PE1_H_PLL_FBKSEL_VAL(0x01)); | ||||
| +		/* DDS NCPO PCW (for host mode) */ | ||||
| +		mt7621_phy_rmw(phy, RG_PE1_H_LCDDS_SSC_PRD_REG, | ||||
| +			       RG_PE1_H_LCDDS_SSC_PRD, | ||||
| +			       RG_PE1_H_LCDDS_SSC_PRD_VAL(0x18000000)); | ||||
| +		/* DDS SSC dither period control */ | ||||
| +		mt7621_phy_rmw(phy, RG_PE1_H_LCDDS_SSC_PRD_REG, | ||||
| +			       RG_PE1_H_LCDDS_SSC_PRD, | ||||
| +			       RG_PE1_H_LCDDS_SSC_PRD_VAL(0x18d)); | ||||
| +		/* DDS SSC dither amplitude control */ | ||||
| +		mt7621_phy_rmw(phy, RG_PE1_H_LCDDS_SSC_DELTA_REG, | ||||
| +			       RG_PE1_H_LCDDS_SSC_DELTA | | ||||
| +			       RG_PE1_H_LCDDS_SSC_DELTA1, | ||||
| +			       RG_PE1_H_LCDDS_SSC_DELTA_VAL(0x4a) | | ||||
| +			       RG_PE1_H_LCDDS_SSC_DELTA1_VAL(0x4a)); | ||||
| +		dev_info(dev, "Xtal is 25MHz\n"); | ||||
| +	} else { /* 20MHz Xtal */ | ||||
| +		mt7621_phy_rmw(phy, RG_PE1_H_PLL_REG, | ||||
| +			       RG_PE1_H_PLL_PREDIV, | ||||
| +			       RG_PE1_H_PLL_PREDIV_VAL(0x00)); | ||||
| + | ||||
| +		dev_info(dev, "Xtal is 20MHz\n"); | ||||
|  	} | ||||
|   | ||||
|  	/* DDS clock inversion */ | ||||
| -	val = phy_read(phy, RG_PE1_LCDDS_CLK_PH_INV_REG); | ||||
| -	val &= ~(RG_PE1_LCDDS_CLK_PH_INV); | ||||
| -	val |= RG_PE1_LCDDS_CLK_PH_INV; | ||||
| -	phy_write(phy, val, RG_PE1_LCDDS_CLK_PH_INV_REG); | ||||
| +	mt7621_phy_rmw(phy, RG_PE1_LCDDS_CLK_PH_INV_REG, | ||||
| +		       RG_PE1_LCDDS_CLK_PH_INV, RG_PE1_LCDDS_CLK_PH_INV); | ||||
|   | ||||
|  	/* Set PLL bits */ | ||||
| -	val = phy_read(phy, RG_PE1_H_PLL_REG); | ||||
| -	val &= ~(RG_PE1_H_PLL_BC | RG_PE1_H_PLL_BP | RG_PE1_H_PLL_IR | | ||||
| -		 RG_PE1_H_PLL_IC | RG_PE1_PLL_DIVEN); | ||||
| -	val |= RG_PE1_H_PLL_BC_VAL(0x02); | ||||
| -	val |= RG_PE1_H_PLL_BP_VAL(0x06); | ||||
| -	val |= RG_PE1_H_PLL_IR_VAL(0x02); | ||||
| -	val |= RG_PE1_H_PLL_IC_VAL(0x01); | ||||
| -	val |= RG_PE1_PLL_DIVEN_VAL(0x02); | ||||
| -	phy_write(phy, val, RG_PE1_H_PLL_REG); | ||||
| - | ||||
| -	val = phy_read(phy, RG_PE1_H_PLL_BR_REG); | ||||
| -	val &= ~(RG_PE1_H_PLL_BR); | ||||
| -	val |= RG_PE1_H_PLL_BR_VAL(0x00); | ||||
| -	phy_write(phy, val, RG_PE1_H_PLL_BR_REG); | ||||
| +	mt7621_phy_rmw(phy, RG_PE1_H_PLL_REG, | ||||
| +		       RG_PE1_H_PLL_BC | RG_PE1_H_PLL_BP | RG_PE1_H_PLL_IR | | ||||
| +		       RG_PE1_H_PLL_IC | RG_PE1_PLL_DIVEN, | ||||
| +		       RG_PE1_H_PLL_BC_VAL(0x02) | RG_PE1_H_PLL_BP_VAL(0x06) | | ||||
| +		       RG_PE1_H_PLL_IR_VAL(0x02) | RG_PE1_H_PLL_IC_VAL(0x01) | | ||||
| +		       RG_PE1_PLL_DIVEN_VAL(0x02)); | ||||
| + | ||||
| +	mt7621_phy_rmw(phy, RG_PE1_H_PLL_BR_REG, | ||||
| +		       RG_PE1_H_PLL_BR, RG_PE1_H_PLL_BR_VAL(0x00)); | ||||
|   | ||||
|  	if (reg <= 5 && reg >= 3) { /* 40MHz Xtal */ | ||||
|  		/* set force mode enable of da_pe1_mstckdiv */ | ||||
| -		val = phy_read(phy, RG_PE1_MSTCKDIV_REG); | ||||
| -		val &= ~(RG_PE1_MSTCKDIV | RG_PE1_FRC_MSTCKDIV); | ||||
| -		val |= (RG_PE1_MSTCKDIV_VAL(0x01) | RG_PE1_FRC_MSTCKDIV); | ||||
| -		phy_write(phy, val, RG_PE1_MSTCKDIV_REG); | ||||
| +		mt7621_phy_rmw(phy, RG_PE1_MSTCKDIV_REG, | ||||
| +			       RG_PE1_MSTCKDIV | RG_PE1_FRC_MSTCKDIV, | ||||
| +			       RG_PE1_MSTCKDIV_VAL(0x01) | RG_PE1_FRC_MSTCKDIV); | ||||
|  	} | ||||
|  } | ||||
|   | ||||
| @@ -252,13 +240,11 @@ static int mt7621_pci_phy_power_on(struc | ||||
|  	struct mt7621_pci_phy *mphy = dev_get_drvdata(phy->dev.parent); | ||||
|  	u32 offset = (instance->index != 1) ? | ||||
|  		RG_PE1_FRC_PHY_REG : RG_PE1_FRC_PHY_REG + RG_P0_TO_P1_WIDTH; | ||||
| -	u32 val; | ||||
|   | ||||
|  	/* Enable PHY and disable force mode */ | ||||
| -	val = phy_read(mphy, offset); | ||||
| -	val &= ~(RG_PE1_FRC_PHY_EN | RG_PE1_PHY_EN); | ||||
| -	val |= (RG_PE1_FRC_PHY_EN | RG_PE1_PHY_EN); | ||||
| -	phy_write(mphy, val, offset); | ||||
| +	mt7621_phy_rmw(mphy, offset, | ||||
| +		       RG_PE1_FRC_PHY_EN | RG_PE1_PHY_EN, | ||||
| +		       RG_PE1_FRC_PHY_EN | RG_PE1_PHY_EN); | ||||
|   | ||||
|  	return 0; | ||||
|  } | ||||
| @@ -269,13 +255,11 @@ static int mt7621_pci_phy_power_off(stru | ||||
|  	struct mt7621_pci_phy *mphy = dev_get_drvdata(phy->dev.parent); | ||||
|  	u32 offset = (instance->index != 1) ? | ||||
|  		RG_PE1_FRC_PHY_REG : RG_PE1_FRC_PHY_REG + RG_P0_TO_P1_WIDTH; | ||||
| -	u32 val; | ||||
|   | ||||
|  	/* Disable PHY */ | ||||
| -	val = phy_read(mphy, offset); | ||||
| -	val &= ~(RG_PE1_FRC_PHY_EN | RG_PE1_PHY_EN); | ||||
| -	val |= RG_PE1_FRC_PHY_EN; | ||||
| -	phy_write(mphy, val, offset); | ||||
| +	mt7621_phy_rmw(mphy, offset, | ||||
| +		       RG_PE1_FRC_PHY_EN | RG_PE1_PHY_EN, | ||||
| +		       RG_PE1_FRC_PHY_EN); | ||||
|   | ||||
|  	return 0; | ||||
|  } | ||||
| @@ -0,0 +1,131 @@ | ||||
| From 3faf4e1c537de86058fc22a851cd979489b9185e Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Wed, 18 Mar 2020 10:44:45 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: fix io space and properly set resource | ||||
|  limits | ||||
|  | ||||
| Function 'mt7621_pci_parse_request_of_pci_ranges' is using | ||||
| 'of_pci_range_to_resource' to get both mem and io resources. | ||||
| Internally this function calls to 'pci_address_to_pio' which | ||||
| returns -1 if io space address is an address > IO_SPACE_LIMIT | ||||
| which is 0xFFFF for mips. This mt7621 soc has io space in physical | ||||
| address 0x1e160000. In order to fix this, overwrite invalid io | ||||
| 0xffffffff  with properly values from the device tree and set | ||||
| mapped address of this resource as io port base memory address | ||||
| calling 'set_io_port_base' function. There is also need to properly | ||||
| setup resource limits and io and memory windows with properly | ||||
| parsed values instead of set them as 'no limit' which it is wrong. | ||||
| For any reason I don't really know legacy driver sets up mem window | ||||
| as 0xFFFFFFFF and any other value seems to does not work as expected, | ||||
| so set up also here with same values. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200318094445.19669-1-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 43 +++++++++++++++++++-------------- | ||||
|  1 file changed, 25 insertions(+), 18 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -118,6 +118,7 @@ struct mt7621_pcie_port { | ||||
|   * @busn: bus range | ||||
|   * @offset: IO / Memory offset | ||||
|   * @dev: Pointer to PCIe device | ||||
| + * @io_map_base: virtual memory base address for io | ||||
|   * @ports: pointer to PCIe port information | ||||
|   * @resets_inverted: depends on chip revision | ||||
|   * reset lines are inverted. | ||||
| @@ -132,6 +133,7 @@ struct mt7621_pcie { | ||||
|  		resource_size_t mem; | ||||
|  		resource_size_t io; | ||||
|  	} offset; | ||||
| +	unsigned long io_map_base; | ||||
|  	struct list_head ports; | ||||
|  	bool resets_inverted; | ||||
|  }; | ||||
| @@ -291,22 +293,21 @@ static int mt7621_pci_parse_request_of_p | ||||
|  	} | ||||
|   | ||||
|  	for_each_of_pci_range(&parser, &range) { | ||||
| -		struct resource *res = NULL; | ||||
| - | ||||
|  		switch (range.flags & IORESOURCE_TYPE_BITS) { | ||||
|  		case IORESOURCE_IO: | ||||
| -			ioremap(range.cpu_addr, range.size); | ||||
| -			res = &pcie->io; | ||||
| +			pcie->io_map_base = | ||||
| +				(unsigned long)ioremap(range.cpu_addr, | ||||
| +						       range.size); | ||||
| +			of_pci_range_to_resource(&range, node, &pcie->io); | ||||
| +			pcie->io.start = range.cpu_addr; | ||||
| +			pcie->io.end = range.cpu_addr + range.size - 1; | ||||
|  			pcie->offset.io = 0x00000000UL; | ||||
|  			break; | ||||
|  		case IORESOURCE_MEM: | ||||
| -			res = &pcie->mem; | ||||
| +			of_pci_range_to_resource(&range, node, &pcie->mem); | ||||
|  			pcie->offset.mem = 0x00000000UL; | ||||
|  			break; | ||||
|  		} | ||||
| - | ||||
| -		if (res) | ||||
| -			of_pci_range_to_resource(&range, node, res); | ||||
|  	} | ||||
|   | ||||
|  	err = of_pci_parse_bus_range(node, &pcie->busn); | ||||
| @@ -318,6 +319,8 @@ static int mt7621_pci_parse_request_of_p | ||||
|  		pcie->busn.flags = IORESOURCE_BUS; | ||||
|  	} | ||||
|   | ||||
| +	set_io_port_base(pcie->io_map_base); | ||||
| + | ||||
|  	return 0; | ||||
|  } | ||||
|   | ||||
| @@ -548,6 +551,10 @@ static void mt7621_pcie_enable_ports(str | ||||
|  	u32 slot; | ||||
|  	u32 val; | ||||
|   | ||||
| +	/* Setup MEMWIN and IOWIN */ | ||||
| +	pcie_write(pcie, 0xffffffff, RALINK_PCI_MEMBASE); | ||||
| +	pcie_write(pcie, pcie->io.start, RALINK_PCI_IOBASE); | ||||
| + | ||||
|  	list_for_each_entry(port, &pcie->ports, list) { | ||||
|  		if (port->enabled) { | ||||
|  			mt7621_pcie_port_clk_enable(port); | ||||
| @@ -668,11 +675,17 @@ static int mt7621_pci_probe(struct platf | ||||
|  		return err; | ||||
|  	} | ||||
|   | ||||
| +	err = mt7621_pci_parse_request_of_pci_ranges(pcie); | ||||
| +	if (err) { | ||||
| +		dev_err(dev, "Error requesting pci resources from ranges"); | ||||
| +		goto out_release_gpios; | ||||
| +	} | ||||
| + | ||||
|  	/* set resources limits */ | ||||
| -	iomem_resource.start = 0; | ||||
| -	iomem_resource.end = ~0UL; /* no limit */ | ||||
| -	ioport_resource.start = 0; | ||||
| -	ioport_resource.end = ~0UL; /* no limit */ | ||||
| +	iomem_resource.start = pcie->mem.start; | ||||
| +	iomem_resource.end = pcie->mem.end; | ||||
| +	ioport_resource.start = pcie->io.start; | ||||
| +	ioport_resource.end = pcie->io.end; | ||||
|   | ||||
|  	mt7621_pcie_init_ports(pcie); | ||||
|   | ||||
| @@ -685,12 +698,6 @@ static int mt7621_pci_probe(struct platf | ||||
|   | ||||
|  	mt7621_pcie_enable_ports(pcie); | ||||
|   | ||||
| -	err = mt7621_pci_parse_request_of_pci_ranges(pcie); | ||||
| -	if (err) { | ||||
| -		dev_err(dev, "Error requesting pci resources from ranges"); | ||||
| -		goto out_release_gpios; | ||||
| -	} | ||||
| - | ||||
|  	setup_cm_memory_region(pcie); | ||||
|   | ||||
|  	err = mt7621_pcie_request_resources(pcie, &res); | ||||
| @@ -0,0 +1,28 @@ | ||||
| From 0a3085ae142d8f5cf905b104bc66db3721a2fa33 Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Thu, 19 Mar 2020 10:57:33 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: fix register to set up virtual bridges | ||||
|  | ||||
| Instead of being using PCI Configuration and Status Register to | ||||
| set up virtual bridges we are using CONFIG_ADDR Register which is | ||||
| wrong. Hence, set the correct value. | ||||
|  | ||||
| Fixes: 9a5e71a68d20 ("staging: mt7621-pci: simplify 'mt7621_pcie_init_virtual_bridges' function") | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200319095733.1557-1-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 2 +- | ||||
|  1 file changed, 1 insertion(+), 1 deletion(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -603,7 +603,7 @@ static int mt7621_pcie_init_virtual_brid | ||||
|  		if ((pcie_link_status & BIT(i)) == 0) | ||||
|  			p2p_br_devnum[i] = n++; | ||||
|   | ||||
| -	pcie_rmw(pcie, RALINK_PCI_CONFIG_ADDR, | ||||
| +	pcie_rmw(pcie, RALINK_PCI_PCICFG_ADDR, | ||||
|  		 PCIE_P2P_BR_DEVNUM_MASK_FULL, | ||||
|  		 (p2p_br_devnum[0] << PCIE_P2P_BR_DEVNUM0_SHIFT) | | ||||
|  		 (p2p_br_devnum[1] << PCIE_P2P_BR_DEVNUM1_SHIFT) | | ||||
| @@ -0,0 +1,34 @@ | ||||
| From 23a788c23ed10e0d79092fcb693dcf0e357e1f7e Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Thu, 19 Mar 2020 17:14:16 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: don't return if get gpio fails | ||||
|  | ||||
| In some platforms gpio's are not used for reset but | ||||
| for other purposes. Because of that when we try to | ||||
| get them are valid gpio's but are already assigned | ||||
| to do other function. To avoid those kind of problems | ||||
| in those platforms just notice the fail in the kernel | ||||
| but continue doing normal boot. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200319161416.19033-1-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 6 ++---- | ||||
|  1 file changed, 2 insertions(+), 4 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -363,10 +363,8 @@ static int mt7621_pcie_parse_port(struct | ||||
|   | ||||
|  	port->gpio_rst = devm_gpiod_get_index_optional(dev, "reset", slot, | ||||
|  						       GPIOD_OUT_LOW); | ||||
| -	if (IS_ERR(port->gpio_rst)) { | ||||
| -		dev_err(dev, "Failed to get GPIO for PCIe%d\n", slot); | ||||
| -		return PTR_ERR(port->gpio_rst); | ||||
| -	} | ||||
| +	if (IS_ERR(port->gpio_rst)) | ||||
| +		dev_notice(dev, "Failed to get GPIO for PCIe%d\n", slot); | ||||
|   | ||||
|  	port->slot = slot; | ||||
|  	port->pcie = pcie; | ||||
| @@ -0,0 +1,272 @@ | ||||
| From 91eb47531421f0e8c9bc4594b4a7caa0e59dc83e Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Fri, 20 Mar 2020 12:01:19 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci-phy: avoid to create to different phys | ||||
|  for a dual port one | ||||
|  | ||||
| This soc has two phy's for the pcie one of them using just a different | ||||
| register for settig it up but sharing all the rest of the config. Until | ||||
| now we was presenting this schema as three different phy's in the device | ||||
| tree using the 'phy-cells' node property to discriminate an index and | ||||
| setting up a complete phy for the dual port index. This sometimes worked | ||||
| properly but reconfiguring the same registers twice presents sometimes | ||||
| some unstable pcie links and the ports was not properly being detected. | ||||
| The problems only appears on hard resets and soft resets was properly | ||||
| working. Instead of having this schema just set two phy's in the device | ||||
| ree and use the 'phy-cells' property to say if the port has or not a dual | ||||
| port. Doing this configuration and set up becomes easier, LOC is decreased | ||||
| and the behaviour also gets deterministic with properly and stable pcie | ||||
| links in both hard and soft resets. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200320110123.9907-2-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci-phy/pci-mt7621-phy.c | 144 ++++++++++-------------- | ||||
|  1 file changed, 59 insertions(+), 85 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci-phy/pci-mt7621-phy.c | ||||
| +++ b/drivers/staging/mt7621-pci-phy/pci-mt7621-phy.c | ||||
| @@ -78,31 +78,21 @@ | ||||
|  #define MAX_PHYS	2 | ||||
|   | ||||
|  /** | ||||
| - * struct mt7621_pci_phy_instance - Mt7621 Pcie PHY device | ||||
| - * @phy: pointer to the kernel PHY device | ||||
| - * @port_base: base register | ||||
| - * @index: internal ID to identify the Mt7621 PCIe PHY | ||||
| - */ | ||||
| -struct mt7621_pci_phy_instance { | ||||
| -	struct phy *phy; | ||||
| -	void __iomem *port_base; | ||||
| -	u32 index; | ||||
| -}; | ||||
| - | ||||
| -/** | ||||
|   * struct mt7621_pci_phy - Mt7621 Pcie PHY core | ||||
|   * @dev: pointer to device | ||||
|   * @regmap: kernel regmap pointer | ||||
| - * @phys: pointer to Mt7621 PHY device | ||||
| - * @nphys: number of PHY devices for this core | ||||
| + * @phy: pointer to the kernel PHY device | ||||
| + * @port_base: base register | ||||
| + * @has_dual_port: if the phy has dual ports. | ||||
|   * @bypass_pipe_rst: mark if 'mt7621_bypass_pipe_rst' | ||||
|   * needs to be executed. Depends on chip revision. | ||||
|   */ | ||||
|  struct mt7621_pci_phy { | ||||
|  	struct device *dev; | ||||
|  	struct regmap *regmap; | ||||
| -	struct mt7621_pci_phy_instance **phys; | ||||
| -	int nphys; | ||||
| +	struct phy *phy; | ||||
| +	void __iomem *port_base; | ||||
| +	bool has_dual_port; | ||||
|  	bool bypass_pipe_rst; | ||||
|  }; | ||||
|   | ||||
| @@ -130,23 +120,23 @@ static inline void mt7621_phy_rmw(struct | ||||
|  	phy_write(phy, val, reg); | ||||
|  } | ||||
|   | ||||
| -static void mt7621_bypass_pipe_rst(struct mt7621_pci_phy *phy, | ||||
| -				   struct mt7621_pci_phy_instance *instance) | ||||
| +static void mt7621_bypass_pipe_rst(struct mt7621_pci_phy *phy) | ||||
|  { | ||||
| -	u32 offset = (instance->index != 1) ? | ||||
| -		RG_PE1_PIPE_REG : RG_PE1_PIPE_REG + RG_P0_TO_P1_WIDTH; | ||||
| +	mt7621_phy_rmw(phy, RG_PE1_PIPE_REG, 0, RG_PE1_PIPE_RST); | ||||
| +	mt7621_phy_rmw(phy, RG_PE1_PIPE_REG, 0, RG_PE1_PIPE_CMD_FRC); | ||||
|   | ||||
| -	mt7621_phy_rmw(phy, offset, | ||||
| -		       RG_PE1_PIPE_RST | RG_PE1_PIPE_CMD_FRC, | ||||
| -		       RG_PE1_PIPE_RST | RG_PE1_PIPE_CMD_FRC); | ||||
| +	if (phy->has_dual_port) { | ||||
| +		mt7621_phy_rmw(phy, RG_PE1_PIPE_REG + RG_P0_TO_P1_WIDTH, | ||||
| +			       0, RG_PE1_PIPE_RST); | ||||
| +		mt7621_phy_rmw(phy, RG_PE1_PIPE_REG + RG_P0_TO_P1_WIDTH, | ||||
| +			       0, RG_PE1_PIPE_CMD_FRC); | ||||
| +	} | ||||
|  } | ||||
|   | ||||
| -static void mt7621_set_phy_for_ssc(struct mt7621_pci_phy *phy, | ||||
| -				   struct mt7621_pci_phy_instance *instance) | ||||
| +static void mt7621_set_phy_for_ssc(struct mt7621_pci_phy *phy) | ||||
|  { | ||||
|  	struct device *dev = phy->dev; | ||||
|  	u32 reg = rt_sysc_r32(SYSC_REG_SYSTEM_CONFIG0); | ||||
| -	u32 offset; | ||||
|   | ||||
|  	reg = (reg >> 6) & 0x7; | ||||
|  	/* Set PCIe Port PHY to disable SSC */ | ||||
| @@ -156,10 +146,13 @@ static void mt7621_set_phy_for_ssc(struc | ||||
|  		       RG_PE1_FRC_H_XTAL_TYPE | RG_PE1_H_XTAL_TYPE_VAL(0x00)); | ||||
|   | ||||
|  	/* disable port */ | ||||
| -	offset = (instance->index != 1) ? | ||||
| -		RG_PE1_FRC_PHY_REG : RG_PE1_FRC_PHY_REG + RG_P0_TO_P1_WIDTH; | ||||
| -	mt7621_phy_rmw(phy, offset, | ||||
| -		       RG_PE1_FRC_PHY_EN | RG_PE1_PHY_EN, RG_PE1_FRC_PHY_EN); | ||||
| +	mt7621_phy_rmw(phy, RG_PE1_FRC_PHY_REG, | ||||
| +		       RG_PE1_PHY_EN, RG_PE1_FRC_PHY_EN); | ||||
| + | ||||
| +	if (phy->has_dual_port) { | ||||
| +		mt7621_phy_rmw(phy, RG_PE1_FRC_PHY_REG + RG_P0_TO_P1_WIDTH, | ||||
| +			       RG_PE1_PHY_EN, RG_PE1_FRC_PHY_EN); | ||||
| +	} | ||||
|   | ||||
|  	if (reg <= 5 && reg >= 3) { /* 40MHz Xtal */ | ||||
|  		/* Set Pre-divider ratio (for host mode) */ | ||||
| @@ -223,43 +216,44 @@ static void mt7621_set_phy_for_ssc(struc | ||||
|   | ||||
|  static int mt7621_pci_phy_init(struct phy *phy) | ||||
|  { | ||||
| -	struct mt7621_pci_phy_instance *instance = phy_get_drvdata(phy); | ||||
| -	struct mt7621_pci_phy *mphy = dev_get_drvdata(phy->dev.parent); | ||||
| +	struct mt7621_pci_phy *mphy = phy_get_drvdata(phy); | ||||
|   | ||||
|  	if (mphy->bypass_pipe_rst) | ||||
| -		mt7621_bypass_pipe_rst(mphy, instance); | ||||
| +		mt7621_bypass_pipe_rst(mphy); | ||||
|   | ||||
| -	mt7621_set_phy_for_ssc(mphy, instance); | ||||
| +	mt7621_set_phy_for_ssc(mphy); | ||||
|   | ||||
|  	return 0; | ||||
|  } | ||||
|   | ||||
|  static int mt7621_pci_phy_power_on(struct phy *phy) | ||||
|  { | ||||
| -	struct mt7621_pci_phy_instance *instance = phy_get_drvdata(phy); | ||||
| -	struct mt7621_pci_phy *mphy = dev_get_drvdata(phy->dev.parent); | ||||
| -	u32 offset = (instance->index != 1) ? | ||||
| -		RG_PE1_FRC_PHY_REG : RG_PE1_FRC_PHY_REG + RG_P0_TO_P1_WIDTH; | ||||
| +	struct mt7621_pci_phy *mphy = phy_get_drvdata(phy); | ||||
|   | ||||
|  	/* Enable PHY and disable force mode */ | ||||
| -	mt7621_phy_rmw(mphy, offset, | ||||
| -		       RG_PE1_FRC_PHY_EN | RG_PE1_PHY_EN, | ||||
| -		       RG_PE1_FRC_PHY_EN | RG_PE1_PHY_EN); | ||||
| +	mt7621_phy_rmw(mphy, RG_PE1_FRC_PHY_REG, | ||||
| +		       RG_PE1_FRC_PHY_EN, RG_PE1_PHY_EN); | ||||
| + | ||||
| +	if (mphy->has_dual_port) { | ||||
| +		mt7621_phy_rmw(mphy, RG_PE1_FRC_PHY_REG + RG_P0_TO_P1_WIDTH, | ||||
| +			       RG_PE1_FRC_PHY_EN, RG_PE1_PHY_EN); | ||||
| +	} | ||||
|   | ||||
|  	return 0; | ||||
|  } | ||||
|   | ||||
|  static int mt7621_pci_phy_power_off(struct phy *phy) | ||||
|  { | ||||
| -	struct mt7621_pci_phy_instance *instance = phy_get_drvdata(phy); | ||||
| -	struct mt7621_pci_phy *mphy = dev_get_drvdata(phy->dev.parent); | ||||
| -	u32 offset = (instance->index != 1) ? | ||||
| -		RG_PE1_FRC_PHY_REG : RG_PE1_FRC_PHY_REG + RG_P0_TO_P1_WIDTH; | ||||
| +	struct mt7621_pci_phy *mphy = phy_get_drvdata(phy); | ||||
|   | ||||
|  	/* Disable PHY */ | ||||
| -	mt7621_phy_rmw(mphy, offset, | ||||
| -		       RG_PE1_FRC_PHY_EN | RG_PE1_PHY_EN, | ||||
| -		       RG_PE1_FRC_PHY_EN); | ||||
| +	mt7621_phy_rmw(mphy, RG_PE1_FRC_PHY_REG, | ||||
| +		       RG_PE1_PHY_EN, RG_PE1_FRC_PHY_EN); | ||||
| + | ||||
| +	if (mphy->has_dual_port) { | ||||
| +		mt7621_phy_rmw(mphy, RG_PE1_FRC_PHY_REG + RG_P0_TO_P1_WIDTH, | ||||
| +			       RG_PE1_PHY_EN, RG_PE1_FRC_PHY_EN); | ||||
| +	} | ||||
|   | ||||
|  	return 0; | ||||
|  } | ||||
| @@ -282,13 +276,15 @@ static struct phy *mt7621_pcie_phy_of_xl | ||||
|  { | ||||
|  	struct mt7621_pci_phy *mt7621_phy = dev_get_drvdata(dev); | ||||
|   | ||||
| -	if (args->args_count == 0) | ||||
| -		return mt7621_phy->phys[0]->phy; | ||||
| - | ||||
|  	if (WARN_ON(args->args[0] >= MAX_PHYS)) | ||||
|  		return ERR_PTR(-ENODEV); | ||||
|   | ||||
| -	return mt7621_phy->phys[args->args[0]]->phy; | ||||
| +	mt7621_phy->has_dual_port = args->args[0]; | ||||
| + | ||||
| +	dev_info(dev, "PHY for 0x%08x (dual port = %d)\n", | ||||
| +		 (unsigned int)mt7621_phy->port_base, mt7621_phy->has_dual_port); | ||||
| + | ||||
| +	return mt7621_phy->phy; | ||||
|  } | ||||
|   | ||||
|  static const struct soc_device_attribute mt7621_pci_quirks_match[] = { | ||||
| @@ -309,19 +305,11 @@ static int mt7621_pci_phy_probe(struct p | ||||
|  	struct phy_provider *provider; | ||||
|  	struct mt7621_pci_phy *phy; | ||||
|  	struct resource *res; | ||||
| -	int port; | ||||
| -	void __iomem *port_base; | ||||
|   | ||||
|  	phy = devm_kzalloc(dev, sizeof(*phy), GFP_KERNEL); | ||||
|  	if (!phy) | ||||
|  		return -ENOMEM; | ||||
|   | ||||
| -	phy->nphys = MAX_PHYS; | ||||
| -	phy->phys = devm_kcalloc(dev, phy->nphys, | ||||
| -				 sizeof(*phy->phys), GFP_KERNEL); | ||||
| -	if (!phy->phys) | ||||
| -		return -ENOMEM; | ||||
| - | ||||
|  	attr = soc_device_match(mt7621_pci_quirks_match); | ||||
|  	if (attr) | ||||
|  		phy->bypass_pipe_rst = true; | ||||
| @@ -335,39 +323,25 @@ static int mt7621_pci_phy_probe(struct p | ||||
|  		return -ENXIO; | ||||
|  	} | ||||
|   | ||||
| -	port_base = devm_ioremap_resource(dev, res); | ||||
| -	if (IS_ERR(port_base)) { | ||||
| +	phy->port_base = devm_ioremap_resource(dev, res); | ||||
| +	if (IS_ERR(phy->port_base)) { | ||||
|  		dev_err(dev, "failed to remap phy regs\n"); | ||||
| -		return PTR_ERR(port_base); | ||||
| +		return PTR_ERR(phy->port_base); | ||||
|  	} | ||||
|   | ||||
| -	phy->regmap = devm_regmap_init_mmio(phy->dev, port_base, | ||||
| +	phy->regmap = devm_regmap_init_mmio(phy->dev, phy->port_base, | ||||
|  					    &mt7621_pci_phy_regmap_config); | ||||
|  	if (IS_ERR(phy->regmap)) | ||||
|  		return PTR_ERR(phy->regmap); | ||||
|   | ||||
| -	for (port = 0; port < MAX_PHYS; port++) { | ||||
| -		struct mt7621_pci_phy_instance *instance; | ||||
| -		struct phy *pphy; | ||||
| - | ||||
| -		instance = devm_kzalloc(dev, sizeof(*instance), GFP_KERNEL); | ||||
| -		if (!instance) | ||||
| -			return -ENOMEM; | ||||
| - | ||||
| -		phy->phys[port] = instance; | ||||
| - | ||||
| -		pphy = devm_phy_create(dev, dev->of_node, &mt7621_pci_phy_ops); | ||||
| -		if (IS_ERR(phy)) { | ||||
| -			dev_err(dev, "failed to create phy\n"); | ||||
| -			return PTR_ERR(phy); | ||||
| -		} | ||||
| - | ||||
| -		instance->port_base = port_base; | ||||
| -		instance->phy = pphy; | ||||
| -		instance->index = port; | ||||
| -		phy_set_drvdata(pphy, instance); | ||||
| +	phy->phy = devm_phy_create(dev, dev->of_node, &mt7621_pci_phy_ops); | ||||
| +	if (IS_ERR(phy)) { | ||||
| +		dev_err(dev, "failed to create phy\n"); | ||||
| +		return PTR_ERR(phy); | ||||
|  	} | ||||
|   | ||||
| +	phy_set_drvdata(phy->phy, phy); | ||||
| + | ||||
|  	provider = devm_of_phy_provider_register(dev, mt7621_pcie_phy_of_xlate); | ||||
|   | ||||
|  	return PTR_ERR_OR_ZERO(provider); | ||||
| @@ -0,0 +1,42 @@ | ||||
| From c752b54bda4d772426c5eeb56978d2e41bd525b4 Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Fri, 20 Mar 2020 12:01:21 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: use only two phys from device tree | ||||
|  | ||||
| In order to align work with the mt7621-pci-phy part of | ||||
| the driver and device tree which is now using only two | ||||
| real phys one of them dual ported properly parse the | ||||
| device tree and don't call phy initialization for the | ||||
| slot 1 because is being taking into account when the | ||||
| phy for the slot 0 is instantiated. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200320110123.9907-4-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 7 ++++++- | ||||
|  1 file changed, 6 insertions(+), 1 deletion(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -358,7 +358,7 @@ static int mt7621_pcie_parse_port(struct | ||||
|   | ||||
|  	snprintf(name, sizeof(name), "pcie-phy%d", slot); | ||||
|  	port->phy = devm_phy_get(dev, name); | ||||
| -	if (IS_ERR(port->phy)) | ||||
| +	if (IS_ERR(port->phy) && slot != 1) | ||||
|  		return PTR_ERR(port->phy); | ||||
|   | ||||
|  	port->gpio_rst = devm_gpiod_get_index_optional(dev, "reset", slot, | ||||
| @@ -495,6 +495,11 @@ static void mt7621_pcie_init_ports(struc | ||||
|  	list_for_each_entry_safe(port, tmp, &pcie->ports, list) { | ||||
|  		u32 slot = port->slot; | ||||
|   | ||||
| +		if (slot == 1) { | ||||
| +			port->enabled = true; | ||||
| +			continue; | ||||
| +		} | ||||
| + | ||||
|  		err = mt7621_pcie_init_port(port); | ||||
|  		if (err) { | ||||
|  			dev_err(dev, "Initiating port %d failed\n", slot); | ||||
| @@ -0,0 +1,26 @@ | ||||
| From b59343b7de448c30e5b098484a7c7c5cb300df2f Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Fri, 20 Mar 2020 12:01:22 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: change variable to print for slot | ||||
|  | ||||
| We are using the counter to print the slot which has been | ||||
| enabled. Use the correct associated slot for the port instead. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200320110123.9907-5-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 2 +- | ||||
|  1 file changed, 1 insertion(+), 1 deletion(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -562,7 +562,7 @@ static void mt7621_pcie_enable_ports(str | ||||
|  		if (port->enabled) { | ||||
|  			mt7621_pcie_port_clk_enable(port); | ||||
|  			mt7621_pcie_enable_port(port); | ||||
| -			dev_info(dev, "PCIE%d enabled\n", num_slots_enabled); | ||||
| +			dev_info(dev, "PCIE%d enabled\n", port->slot); | ||||
|  			num_slots_enabled++; | ||||
|  		} | ||||
|  	} | ||||
| @@ -0,0 +1,33 @@ | ||||
| From 87068309300c707d659ce79232eae827604804a4 Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Fri, 20 Mar 2020 12:01:23 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: be sure gpio descriptor is null on fails | ||||
|  | ||||
| Function 'devm_gpiod_get_index_optional' returns NULL if the | ||||
| descriptor is invalid and the error associated for the error | ||||
| pointer is ENOENT. Sometimes if the pin is just assigned the | ||||
| error associated for the pointer might not be ENOENT but other. | ||||
| In order to avoid weirds behaviours if this happen set descriptor | ||||
| to NULL in the driver port structure. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200320110123.9907-6-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 4 +++- | ||||
|  1 file changed, 3 insertions(+), 1 deletion(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -363,8 +363,10 @@ static int mt7621_pcie_parse_port(struct | ||||
|   | ||||
|  	port->gpio_rst = devm_gpiod_get_index_optional(dev, "reset", slot, | ||||
|  						       GPIOD_OUT_LOW); | ||||
| -	if (IS_ERR(port->gpio_rst)) | ||||
| +	if (IS_ERR(port->gpio_rst)) { | ||||
|  		dev_notice(dev, "Failed to get GPIO for PCIe%d\n", slot); | ||||
| +		port->gpio_rst = NULL; | ||||
| +	} | ||||
|   | ||||
|  	port->slot = slot; | ||||
|  	port->pcie = pcie; | ||||
| @@ -0,0 +1,79 @@ | ||||
| From d81fe3c13aa6f4ab1ec318212d2007175e6d05aa Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Fri, 20 Mar 2020 16:38:37 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: avoid to poweroff the phy for slot one | ||||
|  | ||||
| Phy for slot 0 and 1 is shared and handled properly in slot 0. | ||||
| If there is only one port in use,(slot 0) we shall not call the | ||||
| 'phy_power_off' function with an invalid slot because kernel | ||||
| will crash with an unaligned access fault like the following: | ||||
|  | ||||
| mt7621-pci 1e140000.pcie: Error applying setting, reverse things back | ||||
| mt7621-pci-phy 1e149000.pcie-phy: PHY for 0xbe149000 (dual port = 1) | ||||
| mt7621-pci-phy 1e14a000.pcie-phy: PHY for 0xbe14a000 (dual port = 0) | ||||
| mt7621-pci-phy 1e149000.pcie-phy: Xtal is 40MHz | ||||
| mt7621-pci-phy 1e14a000.pcie-phy: Xtal is 40MHz | ||||
| mt7621-pci 1e140000.pcie: pcie1 no card, disable it (RST & CLK) | ||||
| Unhandled kernel unaligned access[#1]: | ||||
| CPU: 3 PID: 111 Comm: kworker/3:2 Not tainted 5.6.0-rc3-00347-g825c6f470c62-dirty #9 | ||||
| Workqueue: events deferred_probe_work_func | ||||
| $ 0   : 00000000 00000001 5f60d043 8fe1ba80 | ||||
| $ 4   : 0000010d 01eb9000 00000000 00000000 | ||||
| $ 8   : 294b4c00 80940000 00000008 000000ce | ||||
| $12   : 2e303030 00000000 00000000 65696370 | ||||
| $16   : ffffffed 0000010d 8e373cd0 8214c1e0 | ||||
| $20   : 00000000 82144c80 82144680 8214c250 | ||||
| $24   : 00000018 803ef8f4 | ||||
| $28   : 8e372000 8e373c60 8214c080 803940e8 | ||||
| Hi    : 00000125 | ||||
| Lo    : 122f2000 | ||||
| epc   : 807b3328 mutex_lock+0x8/0x44 | ||||
| ra    : 803940e8 phy_power_off+0x28/0xb0 | ||||
| Status: 1100fc03        KERNEL EXL IE | ||||
| Cause : 00800010 (ExcCode 04) | ||||
| BadVA : 0000010d | ||||
| PrId  : 0001992f (MIPS 1004Kc) | ||||
| Modules linked in: | ||||
| Process kworker/3:2 (pid: 111, threadinfo=(ptrval), task=(ptrval), tls=00000000) | ||||
| Stack : 8e373cd0 803fe4f4 8e372000 8e373c90 8214c080 804fde1c 8e373c98 808d62f4 | ||||
|          8e373c78 00000000 8214c254 804fe648 1e160000 804f27b8 00000001 808d62f4 | ||||
|          00000000 00000001 8214c228 808d62f4 80930000 809a0000 8fd47e10 808d63d4 | ||||
|          808d62d4 8fd47e10 808d0000 808d0000 8e373cd0 8e373cd0 809e2a74 809db510 | ||||
|          809db510 00000006 00000001 00000000 00000000 00000000 01000000 1e1440ff | ||||
|          ... | ||||
| Call Trace: | ||||
| [<807b3328>] mutex_lock+0x8/0x44 | ||||
| [<803940e8>] phy_power_off+0x28/0xb0 | ||||
| [<804fe648>] mt7621_pci_probe+0xc20/0xd18 | ||||
| [<80402ab8>] platform_drv_probe+0x40/0x94 | ||||
| [<80400a74>] really_probe+0x104/0x364 | ||||
| [<803feb74>] bus_for_each_drv+0x84/0xdc | ||||
| [<80400924>] __device_attach+0xdc/0x120 | ||||
| [<803ffb5c>] bus_probe_device+0xa0/0xbc | ||||
| [<80400124>] deferred_probe_work_func+0x7c/0xbc | ||||
| [<800420e8>] process_one_work+0x230/0x450 | ||||
| [<80042638>] worker_thread+0x330/0x5fc | ||||
| [<80048eb0>] kthread+0x12c/0x134 | ||||
| [<80007438>] ret_from_kernel_thread+0x14/0x1c | ||||
| Code: 24050002  27bdfff8  8f830000 <c0850000> 14a00005  00000000  00600825  e0810000  1020fffa | ||||
|  | ||||
| Fixes: bf516f413f4e ("staging: mt7621-pci: use only two phys from device tree") | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200320153837.20415-1-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 3 ++- | ||||
|  1 file changed, 2 insertions(+), 1 deletion(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -517,7 +517,8 @@ static void mt7621_pcie_init_ports(struc | ||||
|  		if (!mt7621_pcie_port_is_linkup(port)) { | ||||
|  			dev_err(dev, "pcie%d no card, disable it (RST & CLK)\n", | ||||
|  				slot); | ||||
| -			phy_power_off(port->phy); | ||||
| +			if (slot != 1) | ||||
| +				phy_power_off(port->phy); | ||||
|  			mt7621_control_assert(port); | ||||
|  			mt7621_pcie_port_clk_disable(port); | ||||
|  			port->enabled = false; | ||||
| @@ -0,0 +1,91 @@ | ||||
| From 9d789a7728c37e8730b6a9cca60cf155f18537ea Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Sat, 21 Mar 2020 08:26:50 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: delete release gpios related code | ||||
|  | ||||
| Making gpio8 and gpio9 vendor specific and putting them | ||||
| into the specific dts file makes not needed to release | ||||
| gpios anymore because we are not occupying those pins | ||||
| in the first place if it is not necessary. When the | ||||
| device tree is parsed we can also check and return for | ||||
| the error because we rely in the fact that the related | ||||
| device for the board is correct. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200321072650.7784-3-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 27 +++++++-------------------- | ||||
|  1 file changed, 7 insertions(+), 20 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -364,8 +364,8 @@ static int mt7621_pcie_parse_port(struct | ||||
|  	port->gpio_rst = devm_gpiod_get_index_optional(dev, "reset", slot, | ||||
|  						       GPIOD_OUT_LOW); | ||||
|  	if (IS_ERR(port->gpio_rst)) { | ||||
| -		dev_notice(dev, "Failed to get GPIO for PCIe%d\n", slot); | ||||
| -		port->gpio_rst = NULL; | ||||
| +		dev_err(dev, "Failed to get GPIO for PCIe%d\n", slot); | ||||
| +		return PTR_ERR(port->gpio_rst); | ||||
|  	} | ||||
|   | ||||
|  	port->slot = slot; | ||||
| @@ -474,15 +474,6 @@ static void mt7621_pcie_reset_ep_deasser | ||||
|  	mdelay(PERST_DELAY_MS); | ||||
|  } | ||||
|   | ||||
| -static void mt7621_pcie_release_gpios(struct mt7621_pcie *pcie) | ||||
| -{ | ||||
| -	struct mt7621_pcie_port *port; | ||||
| - | ||||
| -	list_for_each_entry(port, &pcie->ports, list) | ||||
| -		if (port->gpio_rst) | ||||
| -			gpiod_put(port->gpio_rst); | ||||
| -} | ||||
| - | ||||
|  static void mt7621_pcie_init_ports(struct mt7621_pcie *pcie) | ||||
|  { | ||||
|  	struct device *dev = pcie->dev; | ||||
| @@ -684,7 +675,7 @@ static int mt7621_pci_probe(struct platf | ||||
|  	err = mt7621_pci_parse_request_of_pci_ranges(pcie); | ||||
|  	if (err) { | ||||
|  		dev_err(dev, "Error requesting pci resources from ranges"); | ||||
| -		goto out_release_gpios; | ||||
| +		return err; | ||||
|  	} | ||||
|   | ||||
|  	/* set resources limits */ | ||||
| @@ -698,8 +689,7 @@ static int mt7621_pci_probe(struct platf | ||||
|  	err = mt7621_pcie_init_virtual_bridges(pcie); | ||||
|  	if (err) { | ||||
|  		dev_err(dev, "Nothing is connected in virtual bridges. Exiting..."); | ||||
| -		err = 0; | ||||
| -		goto out_release_gpios; | ||||
| +		return 0; | ||||
|  	} | ||||
|   | ||||
|  	mt7621_pcie_enable_ports(pcie); | ||||
| @@ -709,19 +699,16 @@ static int mt7621_pci_probe(struct platf | ||||
|  	err = mt7621_pcie_request_resources(pcie, &res); | ||||
|  	if (err) { | ||||
|  		dev_err(dev, "Error requesting resources\n"); | ||||
| -		goto out_release_gpios; | ||||
| +		return err; | ||||
|  	} | ||||
|   | ||||
|  	err = mt7621_pcie_register_host(bridge, &res); | ||||
|  	if (err) { | ||||
|  		dev_err(dev, "Error registering host\n"); | ||||
| -		goto out_release_gpios; | ||||
| +		return err; | ||||
|  	} | ||||
|   | ||||
| -out_release_gpios: | ||||
| -	mt7621_pcie_release_gpios(pcie); | ||||
| - | ||||
| -	return err; | ||||
| +	return 0; | ||||
|  } | ||||
|   | ||||
|  static const struct of_device_id mt7621_pci_ids[] = { | ||||
| @@ -0,0 +1,29 @@ | ||||
| From 60a15339ceab9fc2a6cdc85fd54b66b2c947ab4e Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Sat, 21 Mar 2020 14:36:21 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: use builtin_platform_driver() | ||||
|  | ||||
| Macro builtin_platform_driver can be used for builtin drivers | ||||
| that don't do anything in driver init. So, use the macro | ||||
| builtin_platform_driver and remove some boilerplate code. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200321133624.31388-1-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 7 +------ | ||||
|  1 file changed, 1 insertion(+), 6 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -725,9 +725,4 @@ static struct platform_driver mt7621_pci | ||||
|  	}, | ||||
|  }; | ||||
|   | ||||
| -static int __init mt7621_pci_init(void) | ||||
| -{ | ||||
| -	return platform_driver_register(&mt7621_pci_driver); | ||||
| -} | ||||
| - | ||||
| -module_init(mt7621_pci_init); | ||||
| +builtin_platform_driver(mt7621_pci_driver); | ||||
| @@ -0,0 +1,32 @@ | ||||
| From ffe3dee4081055b4f58bc50dd3f5c97de42cf126 Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Sat, 21 Mar 2020 14:36:23 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci-phy: use builtin_platform_driver() | ||||
|  | ||||
| Macro builtin_platform_driver can be used for builtin drivers | ||||
| that don't do anything in driver init. So, use the macro | ||||
| builtin_platform_driver and remove some boilerplate code. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200321133624.31388-3-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci-phy/pci-mt7621-phy.c | 7 +------ | ||||
|  1 file changed, 1 insertion(+), 6 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci-phy/pci-mt7621-phy.c | ||||
| +++ b/drivers/staging/mt7621-pci-phy/pci-mt7621-phy.c | ||||
| @@ -361,12 +361,7 @@ static struct platform_driver mt7621_pci | ||||
|  	}, | ||||
|  }; | ||||
|   | ||||
| -static int __init mt7621_pci_phy_drv_init(void) | ||||
| -{ | ||||
| -	return platform_driver_register(&mt7621_pci_phy_driver); | ||||
| -} | ||||
| - | ||||
| -module_init(mt7621_pci_phy_drv_init); | ||||
| +builtin_platform_driver(mt7621_pci_phy_driver); | ||||
|   | ||||
|  MODULE_AUTHOR("Sergio Paracuellos <sergio.paracuellos@gmail.com>"); | ||||
|  MODULE_DESCRIPTION("MediaTek MT7621 PCIe PHY driver"); | ||||
| @@ -0,0 +1,68 @@ | ||||
| From ff83e3023cb8fc3b5dfc12e0c91bf1eb9dc4c4c6 Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Sat, 21 Mar 2020 14:36:24 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci-phy: re-do 'xtal_mode' detection | ||||
|  | ||||
| Detection of the Xtal mode is using magic numbers that | ||||
| can be avoided using properly some definitions and a more | ||||
| accurate variable name from 'reg' into 'xtal_mode'. This | ||||
| increase readability. | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200321133624.31388-4-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci-phy/pci-mt7621-phy.c | 15 ++++++++++----- | ||||
|  1 file changed, 10 insertions(+), 5 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci-phy/pci-mt7621-phy.c | ||||
| +++ b/drivers/staging/mt7621-pci-phy/pci-mt7621-phy.c | ||||
| @@ -75,6 +75,9 @@ | ||||
|   | ||||
|  #define RG_PE1_FRC_MSTCKDIV			BIT(5) | ||||
|   | ||||
| +#define XTAL_MODE_SEL_SHIFT			6 | ||||
| +#define XTAL_MODE_SEL_MASK			0x7 | ||||
| + | ||||
|  #define MAX_PHYS	2 | ||||
|   | ||||
|  /** | ||||
| @@ -136,9 +139,11 @@ static void mt7621_bypass_pipe_rst(struc | ||||
|  static void mt7621_set_phy_for_ssc(struct mt7621_pci_phy *phy) | ||||
|  { | ||||
|  	struct device *dev = phy->dev; | ||||
| -	u32 reg = rt_sysc_r32(SYSC_REG_SYSTEM_CONFIG0); | ||||
| +	u32 xtal_mode; | ||||
| + | ||||
| +	xtal_mode = (rt_sysc_r32(SYSC_REG_SYSTEM_CONFIG0) | ||||
| +		     >> XTAL_MODE_SEL_SHIFT) & XTAL_MODE_SEL_MASK; | ||||
|   | ||||
| -	reg = (reg >> 6) & 0x7; | ||||
|  	/* Set PCIe Port PHY to disable SSC */ | ||||
|  	/* Debug Xtal Type */ | ||||
|  	mt7621_phy_rmw(phy, RG_PE1_FRC_H_XTAL_REG, | ||||
| @@ -154,13 +159,13 @@ static void mt7621_set_phy_for_ssc(struc | ||||
|  			       RG_PE1_PHY_EN, RG_PE1_FRC_PHY_EN); | ||||
|  	} | ||||
|   | ||||
| -	if (reg <= 5 && reg >= 3) { /* 40MHz Xtal */ | ||||
| +	if (xtal_mode <= 5 && xtal_mode >= 3) { /* 40MHz Xtal */ | ||||
|  		/* Set Pre-divider ratio (for host mode) */ | ||||
|  		mt7621_phy_rmw(phy, RG_PE1_H_PLL_REG, | ||||
|  			       RG_PE1_H_PLL_PREDIV, | ||||
|  			       RG_PE1_H_PLL_PREDIV_VAL(0x01)); | ||||
|  		dev_info(dev, "Xtal is 40MHz\n"); | ||||
| -	} else if (reg >= 6) { /* 25MHz Xal */ | ||||
| +	} else if (xtal_mode >= 6) { /* 25MHz Xal */ | ||||
|  		mt7621_phy_rmw(phy, RG_PE1_H_PLL_REG, | ||||
|  			       RG_PE1_H_PLL_PREDIV, | ||||
|  			       RG_PE1_H_PLL_PREDIV_VAL(0x00)); | ||||
| @@ -206,7 +211,7 @@ static void mt7621_set_phy_for_ssc(struc | ||||
|  	mt7621_phy_rmw(phy, RG_PE1_H_PLL_BR_REG, | ||||
|  		       RG_PE1_H_PLL_BR, RG_PE1_H_PLL_BR_VAL(0x00)); | ||||
|   | ||||
| -	if (reg <= 5 && reg >= 3) { /* 40MHz Xtal */ | ||||
| +	if (xtal_mode <= 5 && xtal_mode >= 3) { /* 40MHz Xtal */ | ||||
|  		/* set force mode enable of da_pe1_mstckdiv */ | ||||
|  		mt7621_phy_rmw(phy, RG_PE1_MSTCKDIV_REG, | ||||
|  			       RG_PE1_MSTCKDIV | RG_PE1_FRC_MSTCKDIV, | ||||
| @@ -0,0 +1,35 @@ | ||||
| From 4f0f36b67564311a4ce4441510ef94848febbab2 Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Sun, 22 Mar 2020 08:21:28 +0100 | ||||
| Subject: [PATCH] staging: mt7621-pci: avoid to set 'iomem_resource' addresses | ||||
|  | ||||
| Setting up kernel resource 'iomem_resource' for PCI with | ||||
| addresses parsed from device tree gots into a conflict within | ||||
| the usb xhci driver: | ||||
|  | ||||
| xhci-mtk 1e1c0000.xhci: can't request region for resource [mem 0x1e1c0000-0x1e1c0fff] | ||||
| xhci-mtk: probe of 1e1c0000.xhci failed with error -16 | ||||
|  | ||||
| Don't assign it and maintain the default addresses for this | ||||
| resource seems to fix the problem. Checking legacy driver it | ||||
| is being only  setting the 'ioport_resource'. | ||||
|  | ||||
| Fixes: 09dd629eeabb ("staging: mt7621-pci: fix io space and properly set resource limits") | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200322072128.4454-1-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 2 -- | ||||
|  1 file changed, 2 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -679,8 +679,6 @@ static int mt7621_pci_probe(struct platf | ||||
|  	} | ||||
|   | ||||
|  	/* set resources limits */ | ||||
| -	iomem_resource.start = pcie->mem.start; | ||||
| -	iomem_resource.end = pcie->mem.end; | ||||
|  	ioport_resource.start = pcie->io.start; | ||||
|  	ioport_resource.end = pcie->io.end; | ||||
|   | ||||
| @@ -0,0 +1,65 @@ | ||||
| From 5fcded5e857cf66c9592e4be28c4dab4520c9177 Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Thu, 9 Apr 2020 13:16:52 +0200 | ||||
| Subject: [PATCH] staging: mt7621-pci: properly power off dual-ported pcie phy | ||||
|  | ||||
| Pcie phy for pcie0 and pcie1 is shared using a dual ported | ||||
| one. Current code was assuming that if nothing is connected | ||||
| in pcie0 it won't be also nothing connected in pcie1. This | ||||
| assumtion is wrong for some devices such us 'Mikrotik rbm33g' | ||||
| and 'ZyXEL LTE3301-PLUS' where only connecting a card to the | ||||
| second bus on the phy is possible. For such devices kernel | ||||
| hangs in the same point because of the wrong poweroff of the | ||||
| phy getting the following trace: | ||||
|  | ||||
| mt7621-pci-phy 1e149000.pcie-phy: PHY for 0xbe149000 (dual port = 1) | ||||
| mt7621-pci-phy 1e14a000.pcie-phy: PHY for 0xbe14a000 (dual port = 0) | ||||
| mt7621-pci-phy 1e149000.pcie-phy: Xtal is 40MHz | ||||
| mt7621-pci-phy 1e14a000.pcie-phy: Xtal is 40MHz | ||||
| mt7621-pci 1e140000.pcie: pcie0 no card, disable it (RST & CLK) | ||||
| [hangs] | ||||
|  | ||||
| The wrong assumption is located in the 'mt7621_pcie_init_ports' | ||||
| function where we are just making a power off of the phy for | ||||
| slots 0 and 2 if nothing is connected in them. Hence, only | ||||
| poweroff the phy if nothing is connected in both slot 0 and | ||||
| slot 1 avoiding the kernel to hang. | ||||
|  | ||||
| Fixes: 5737cfe87a9c ("staging: mt7621-pci: avoid to poweroff the phy for slot one") | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200409111652.30964-1-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 12 ++++++++++-- | ||||
|  1 file changed, 10 insertions(+), 2 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -502,17 +502,25 @@ static void mt7621_pcie_init_ports(struc | ||||
|   | ||||
|  	mt7621_pcie_reset_ep_deassert(pcie); | ||||
|   | ||||
| +	tmp = NULL; | ||||
|  	list_for_each_entry(port, &pcie->ports, list) { | ||||
|  		u32 slot = port->slot; | ||||
|   | ||||
|  		if (!mt7621_pcie_port_is_linkup(port)) { | ||||
|  			dev_err(dev, "pcie%d no card, disable it (RST & CLK)\n", | ||||
|  				slot); | ||||
| -			if (slot != 1) | ||||
| -				phy_power_off(port->phy); | ||||
|  			mt7621_control_assert(port); | ||||
|  			mt7621_pcie_port_clk_disable(port); | ||||
|  			port->enabled = false; | ||||
| + | ||||
| +			if (slot == 0) { | ||||
| +				tmp = port; | ||||
| +				continue; | ||||
| +			} | ||||
| + | ||||
| +			if (slot == 1 && tmp && !tmp->enabled) | ||||
| +				phy_power_off(tmp->phy); | ||||
| + | ||||
|  		} | ||||
|  	} | ||||
|  } | ||||
| @@ -0,0 +1,157 @@ | ||||
| From fab6710e4c51f4eb622f95a08322ab5fdbe3f295 Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Mon, 13 Apr 2020 07:59:42 +0200 | ||||
| Subject: [PATCH] staging: mt7621-pci: fix PCIe interrupt mapping | ||||
|  | ||||
| MT7621 has three assigned interrupts for the pcie. This | ||||
| interrupts should properly being mapped taking into account | ||||
| which devices are finally connected in which bus according | ||||
| to link status. So the irq mappings should be as follows | ||||
| according to link status (three bits indicating which devices | ||||
| are link up): | ||||
|  | ||||
| * For PCIe Bus 1 slot 0: | ||||
|   - status = 0x2 || status = 0x6 => IRQ = pcie1_irq (24). | ||||
|   - status = 0x4 => IRQ = pcie2_irq (25). | ||||
|   - default => IRQ = pcie0_irq (23). | ||||
| * For PCIe Bus 2 slot 0: | ||||
|   - status = 0x5 || status = 0x6 => IRQ = pcie2_irq (25). | ||||
|   - default => IRQ = pcie1_irq (24). | ||||
| * For PCIe Bus 2 slot 1: | ||||
|   - status = 0x5 || status = 0x6 => IRQ = pcie2_irq (25). | ||||
|   - default => IRQ = pcie1_irq (24). | ||||
| * For PCIe Bus 3 any slot: | ||||
|   - default => IRQ = pcie2_irq (25). | ||||
|  | ||||
| Because of this, the function 'of_irq_parse_and_map_pci' cannot | ||||
| be used and we need to change device tree information from using | ||||
| the 'interrupt-map' and 'interrupt-map-mask' properties into an | ||||
| 'interrupts' property to be able to get irq information from the | ||||
| ports using the 'platform_get_irq' and storing an 'irq-map' into | ||||
| the pcie driver data node to properly map correct irq using a | ||||
| new 'mt7621_map_irq' function where this map will be read and the | ||||
| correct irq returned. | ||||
|  | ||||
| Fixes: 46d093124df4 ("staging: mt7621-pci: improve interrupt mapping") | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Link: https://lore.kernel.org/r/20200413055942.2714-1-sergio.paracuellos@gmail.com | ||||
| Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| --- | ||||
|  drivers/staging/mt7621-dts/mt7621.dtsi  |  9 +++---- | ||||
|  drivers/staging/mt7621-pci/pci-mt7621.c | 36 +++++++++++++++++++++++-- | ||||
|  2 files changed, 38 insertions(+), 7 deletions(-) | ||||
|  | ||||
| --- a/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| +++ b/drivers/staging/mt7621-pci/pci-mt7621.c | ||||
| @@ -97,6 +97,7 @@ | ||||
|   * @pcie_rst: pointer to port reset control | ||||
|   * @gpio_rst: gpio reset | ||||
|   * @slot: port slot | ||||
| + * @irq: GIC irq | ||||
|   * @enabled: indicates if port is enabled | ||||
|   */ | ||||
|  struct mt7621_pcie_port { | ||||
| @@ -107,6 +108,7 @@ struct mt7621_pcie_port { | ||||
|  	struct reset_control *pcie_rst; | ||||
|  	struct gpio_desc *gpio_rst; | ||||
|  	u32 slot; | ||||
| +	int irq; | ||||
|  	bool enabled; | ||||
|  }; | ||||
|   | ||||
| @@ -120,6 +122,7 @@ struct mt7621_pcie_port { | ||||
|   * @dev: Pointer to PCIe device | ||||
|   * @io_map_base: virtual memory base address for io | ||||
|   * @ports: pointer to PCIe port information | ||||
| + * @irq_map: irq mapping info according pcie link status | ||||
|   * @resets_inverted: depends on chip revision | ||||
|   * reset lines are inverted. | ||||
|   */ | ||||
| @@ -135,6 +138,7 @@ struct mt7621_pcie { | ||||
|  	} offset; | ||||
|  	unsigned long io_map_base; | ||||
|  	struct list_head ports; | ||||
| +	int irq_map[PCIE_P2P_MAX]; | ||||
|  	bool resets_inverted; | ||||
|  }; | ||||
|   | ||||
| @@ -279,6 +283,16 @@ static void setup_cm_memory_region(struc | ||||
|  	} | ||||
|  } | ||||
|   | ||||
| +static int mt7621_map_irq(const struct pci_dev *pdev, u8 slot, u8 pin) | ||||
| +{ | ||||
| +	struct mt7621_pcie *pcie = pdev->bus->sysdata; | ||||
| +	struct device *dev = pcie->dev; | ||||
| +	int irq = pcie->irq_map[slot]; | ||||
| + | ||||
| +	dev_info(dev, "bus=%d slot=%d irq=%d\n", pdev->bus->number, slot, irq); | ||||
| +	return irq; | ||||
| +} | ||||
| + | ||||
|  static int mt7621_pci_parse_request_of_pci_ranges(struct mt7621_pcie *pcie) | ||||
|  { | ||||
|  	struct device *dev = pcie->dev; | ||||
| @@ -330,6 +344,7 @@ static int mt7621_pcie_parse_port(struct | ||||
|  { | ||||
|  	struct mt7621_pcie_port *port; | ||||
|  	struct device *dev = pcie->dev; | ||||
| +	struct platform_device *pdev = to_platform_device(dev); | ||||
|  	struct device_node *pnode = dev->of_node; | ||||
|  	struct resource regs; | ||||
|  	char name[10]; | ||||
| @@ -371,6 +386,12 @@ static int mt7621_pcie_parse_port(struct | ||||
|  	port->slot = slot; | ||||
|  	port->pcie = pcie; | ||||
|   | ||||
| +	port->irq = platform_get_irq(pdev, slot); | ||||
| +	if (port->irq < 0) { | ||||
| +		dev_err(dev, "Failed to get IRQ for PCIe%d\n", slot); | ||||
| +		return -ENXIO; | ||||
| +	} | ||||
| + | ||||
|  	INIT_LIST_HEAD(&port->list); | ||||
|  	list_add_tail(&port->list, &pcie->ports); | ||||
|   | ||||
| @@ -585,13 +606,15 @@ static int mt7621_pcie_init_virtual_brid | ||||
|  { | ||||
|  	u32 pcie_link_status = 0; | ||||
|  	u32 n; | ||||
| -	int i; | ||||
| +	int i = 0; | ||||
|  	u32 p2p_br_devnum[PCIE_P2P_MAX]; | ||||
| +	int irqs[PCIE_P2P_MAX]; | ||||
|  	struct mt7621_pcie_port *port; | ||||
|   | ||||
|  	list_for_each_entry(port, &pcie->ports, list) { | ||||
|  		u32 slot = port->slot; | ||||
|   | ||||
| +		irqs[i++] = port->irq; | ||||
|  		if (port->enabled) | ||||
|  			pcie_link_status |= BIT(slot); | ||||
|  	} | ||||
| @@ -614,6 +637,15 @@ static int mt7621_pcie_init_virtual_brid | ||||
|  		 (p2p_br_devnum[1] << PCIE_P2P_BR_DEVNUM1_SHIFT) | | ||||
|  		 (p2p_br_devnum[2] << PCIE_P2P_BR_DEVNUM2_SHIFT)); | ||||
|   | ||||
| +	/* Assign IRQs */ | ||||
| +	n = 0; | ||||
| +	for (i = 0; i < PCIE_P2P_MAX; i++) | ||||
| +		if (pcie_link_status & BIT(i)) | ||||
| +			pcie->irq_map[n++] = irqs[i]; | ||||
| + | ||||
| +	for (i = n; i < PCIE_P2P_MAX; i++) | ||||
| +		pcie->irq_map[i] = -1; | ||||
| + | ||||
|  	return 0; | ||||
|  } | ||||
|   | ||||
| @@ -638,7 +670,7 @@ static int mt7621_pcie_register_host(str | ||||
|  	host->busnr = pcie->busn.start; | ||||
|  	host->dev.parent = pcie->dev; | ||||
|  	host->ops = &mt7621_pci_ops; | ||||
| -	host->map_irq = of_irq_parse_and_map_pci; | ||||
| +	host->map_irq = mt7621_map_irq; | ||||
|  	host->swizzle_irq = pci_common_swizzle; | ||||
|  	host->sysdata = pcie; | ||||
|   | ||||
| @@ -0,0 +1,26 @@ | ||||
| From 1f0400d0e2c410b04f246aefb2e9b5155eb4b0bf Mon Sep 17 00:00:00 2001 | ||||
| From: Chuanhong Guo <gch981213@gmail.com> | ||||
| Date: Tue, 13 Oct 2020 10:05:47 +0800 | ||||
| Subject: mips: ralink: enable zboot support | ||||
|  | ||||
| Some of these ralink devices come with an ancient u-boot which can't | ||||
| extract LZMA properly when image gets too big. | ||||
| Enable zboot support to get a self-extracting kernel instead of relying | ||||
| on broken u-boot support. | ||||
|  | ||||
| Signed-off-by: Chuanhong Guo <gch981213@gmail.com> | ||||
| Signed-off-by: Thomas Bogendoerfer <tsbogend@alpha.franken.de> | ||||
| --- | ||||
|  arch/mips/Kconfig | 1 + | ||||
|  1 file changed, 1 insertion(+) | ||||
|  | ||||
| --- a/arch/mips/Kconfig | ||||
| +++ b/arch/mips/Kconfig | ||||
| @@ -625,6 +625,7 @@ config RALINK | ||||
|  	select SYS_SUPPORTS_32BIT_KERNEL | ||||
|  	select SYS_SUPPORTS_LITTLE_ENDIAN | ||||
|  	select SYS_SUPPORTS_MIPS16 | ||||
| +	select SYS_SUPPORTS_ZBOOT | ||||
|  	select SYS_HAS_EARLY_PRINTK | ||||
|  	select CLKDEV_LOOKUP | ||||
|  	select ARCH_HAS_RESET_CONTROLLER | ||||
| @@ -0,0 +1,45 @@ | ||||
| From 3f9ef7785a9cd69cb75f5e2ea4ca79a24752e496 Mon Sep 17 00:00:00 2001 | ||||
| From: Sander Vanheule <sander@svanheule.net> | ||||
| Date: Wed, 3 Feb 2021 10:21:41 +0100 | ||||
| Subject: MIPS: ralink: manage low reset lines | ||||
|  | ||||
| Reset lines with indices smaller than 8 are currently considered invalid | ||||
| by the rt2880-reset reset controller. | ||||
|  | ||||
| The MT7621 SoC uses a number of these low reset lines. The DTS defines | ||||
| reset lines "hsdma", "fe", and "mcm" with respective values 5, 6, and 2. | ||||
| As a result of the above restriction, these resets cannot be asserted or | ||||
| de-asserted by the reset controller. In cases where the bootloader does | ||||
| not de-assert these lines, this results in e.g. the MT7621's internal | ||||
| switch staying in reset. | ||||
|  | ||||
| Change the reset controller to only ignore the system reset, so all | ||||
| reset lines with index greater than 0 are considered valid. | ||||
|  | ||||
| Signed-off-by: Sander Vanheule <sander@svanheule.net> | ||||
| Acked-by: John Crispin <john@phrozen.org> | ||||
| Signed-off-by: Thomas Bogendoerfer <tsbogend@alpha.franken.de> | ||||
| --- | ||||
|  arch/mips/ralink/reset.c | 4 ++-- | ||||
|  1 file changed, 2 insertions(+), 2 deletions(-) | ||||
|  | ||||
| --- a/arch/mips/ralink/reset.c | ||||
| +++ b/arch/mips/ralink/reset.c | ||||
| @@ -27,7 +27,7 @@ static int ralink_assert_device(struct r | ||||
|  { | ||||
|  	u32 val; | ||||
|   | ||||
| -	if (id < 8) | ||||
| +	if (id == 0) | ||||
|  		return -1; | ||||
|   | ||||
|  	val = rt_sysc_r32(SYSC_REG_RESET_CTRL); | ||||
| @@ -42,7 +42,7 @@ static int ralink_deassert_device(struct | ||||
|  { | ||||
|  	u32 val; | ||||
|   | ||||
| -	if (id < 8) | ||||
| +	if (id == 0) | ||||
|  		return -1; | ||||
|   | ||||
|  	val = rt_sysc_r32(SYSC_REG_RESET_CTRL); | ||||
							
								
								
									
										97
									
								
								target/linux/ramips/patches-5.10/0200-linkit_bootstrap.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										97
									
								
								target/linux/ramips/patches-5.10/0200-linkit_bootstrap.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,97 @@ | ||||
| --- a/drivers/misc/Makefile | ||||
| +++ b/drivers/misc/Makefile | ||||
| @@ -52,6 +52,7 @@ obj-$(CONFIG_ECHO)		+= echo/ | ||||
|  obj-$(CONFIG_VEXPRESS_SYSCFG)	+= vexpress-syscfg.o | ||||
|  obj-$(CONFIG_CXL_BASE)		+= cxl/ | ||||
|  obj-$(CONFIG_PCI_ENDPOINT_TEST)	+= pci_endpoint_test.o | ||||
| +obj-$(CONFIG_SOC_MT7620)	+= linkit.o | ||||
|  obj-$(CONFIG_OCXL)		+= ocxl/ | ||||
|  obj-y				+= cardreader/ | ||||
|  obj-$(CONFIG_PVPANIC)   	+= pvpanic.o | ||||
| --- /dev/null | ||||
| +++ b/drivers/misc/linkit.c | ||||
| @@ -0,0 +1,84 @@ | ||||
| +/* | ||||
| + *  This program is free software; you can redistribute it and/or modify | ||||
| + *  it under the terms of the GNU General Public License version 2 as | ||||
| + *  publishhed by the Free Software Foundation. | ||||
| + * | ||||
| + *  Copyright (C) 2015 John Crispin <blogic@openwrt.org> | ||||
| + */ | ||||
| + | ||||
| +#include <linux/module.h> | ||||
| +#include <linux/platform_device.h> | ||||
| +#include <linux/of.h> | ||||
| +#include <linux/mtd/mtd.h> | ||||
| +#include <linux/gpio.h> | ||||
| + | ||||
| +#define LINKIT_LATCH_GPIO	11 | ||||
| + | ||||
| +struct linkit_hw_data { | ||||
| +	char board[16]; | ||||
| +	char rev[16]; | ||||
| +}; | ||||
| + | ||||
| +static void sanify_string(char *s) | ||||
| +{ | ||||
| +	int i; | ||||
| + | ||||
| +	for (i = 0; i < 15; i++) | ||||
| +		if (s[i] <= 0x20) | ||||
| +			s[i] = '\0'; | ||||
| +	s[15] = '\0'; | ||||
| +} | ||||
| + | ||||
| +static int linkit_probe(struct platform_device *pdev) | ||||
| +{ | ||||
| +	struct linkit_hw_data hw; | ||||
| +	struct mtd_info *mtd; | ||||
| +	size_t retlen; | ||||
| +	int ret; | ||||
| + | ||||
| +	mtd = get_mtd_device_nm("factory"); | ||||
| +	if (IS_ERR(mtd)) | ||||
| +		return PTR_ERR(mtd); | ||||
| + | ||||
| +	ret = mtd_read(mtd, 0x400, sizeof(hw), &retlen, (u_char *) &hw); | ||||
| +	put_mtd_device(mtd); | ||||
| + | ||||
| +	sanify_string(hw.board); | ||||
| +	sanify_string(hw.rev); | ||||
| + | ||||
| +	dev_info(&pdev->dev, "Version  : %s\n", hw.board); | ||||
| +	dev_info(&pdev->dev, "Revision : %s\n", hw.rev); | ||||
| + | ||||
| +	if (!strcmp(hw.board, "LINKITS7688")) { | ||||
| +		dev_info(&pdev->dev, "setting up bootstrap latch\n"); | ||||
| + | ||||
| +		if (devm_gpio_request(&pdev->dev, LINKIT_LATCH_GPIO, "bootstrap")) { | ||||
| +			dev_err(&pdev->dev, "failed to setup bootstrap gpio\n"); | ||||
| +			return -1; | ||||
| +		} | ||||
| +		gpio_direction_output(LINKIT_LATCH_GPIO, 0); | ||||
| +	} | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static const struct of_device_id linkit_match[] = { | ||||
| +	{ .compatible = "mediatek,linkit" }, | ||||
| +	{}, | ||||
| +}; | ||||
| +MODULE_DEVICE_TABLE(of, linkit_match); | ||||
| + | ||||
| +static struct platform_driver linkit_driver = { | ||||
| +	.probe = linkit_probe, | ||||
| +	.driver = { | ||||
| +		.name = "mtk-linkit", | ||||
| +		.owner = THIS_MODULE, | ||||
| +		.of_match_table = linkit_match, | ||||
| +	}, | ||||
| +}; | ||||
| + | ||||
| +int __init linkit_init(void) | ||||
| +{ | ||||
| +	return platform_driver_register(&linkit_driver); | ||||
| +} | ||||
| +late_initcall_sync(linkit_init); | ||||
										
											
												File diff suppressed because it is too large
												Load Diff
											
										
									
								
							| @@ -0,0 +1,85 @@ | ||||
| From 3d5f4da8296b23eb3abf8b13122b0d06a215e79c Mon Sep 17 00:00:00 2001 | ||||
| From: Weijie Gao <weijie.gao@mediatek.com> | ||||
| Date: Wed, 1 Apr 2020 02:07:59 +0800 | ||||
| Subject: [PATCH 2/2] dt-bindings: add documentation for mt7621-nand driver | ||||
|  | ||||
| This patch adds documentation for MediaTek MT7621 NAND flash controller | ||||
| driver. | ||||
|  | ||||
| Signed-off-by: Weijie Gao <weijie.gao@mediatek.com> | ||||
| --- | ||||
|  .../bindings/mtd/mediatek,mt7621-nfc.yaml          | 68 ++++++++++++++++++++++ | ||||
|  1 file changed, 68 insertions(+) | ||||
|  create mode 100644 Documentation/devicetree/bindings/mtd/mediatek,mt7621-nfc.yaml | ||||
|  | ||||
| --- /dev/null | ||||
| +++ b/Documentation/devicetree/bindings/mtd/mediatek,mt7621-nfc.yaml | ||||
| @@ -0,0 +1,68 @@ | ||||
| +# SPDX-License-Identifier: GPL-2.0 | ||||
| +%YAML 1.2 | ||||
| +--- | ||||
| +$id: http://devicetree.org/schemas/mtd/mediatek,mt7621-nfc.yaml# | ||||
| +$schema: http://devicetree.org/meta-schemas/core.yaml# | ||||
| + | ||||
| +title: MediaTek MT7621 SoC NAND Flash Controller (NFC) DT binding | ||||
| + | ||||
| +maintainers: | ||||
| +  - Weijie Gao <weijie.gao@mediatek.com> | ||||
| + | ||||
| +description: | | ||||
| +  This driver uses a single node to describe both NAND Flash controller | ||||
| +  interface (NFI) and ECC engine for MT7621 SoC. | ||||
| +  MT7621 supports only one chip select. | ||||
| + | ||||
| +properties: | ||||
| +  "#address-cells": false | ||||
| +  "#size-cells": false | ||||
| + | ||||
| +  compatible: | ||||
| +    enum: | ||||
| +      - mediatek,mt7621-nfc | ||||
| + | ||||
| +  reg: | ||||
| +    items: | ||||
| +      - description: Register base of NFI core | ||||
| +      - description: Register base of ECC engine | ||||
| + | ||||
| +  reg-names: | ||||
| +    items: | ||||
| +      - const: nfi | ||||
| +      - const: ecc | ||||
| + | ||||
| +  clocks: | ||||
| +    items: | ||||
| +      - description: Source clock for NFI core, fixed 125MHz | ||||
| + | ||||
| +  clock-names: | ||||
| +    items: | ||||
| +      - const: nfi_clk | ||||
| + | ||||
| +required: | ||||
| +  - compatible | ||||
| +  - reg | ||||
| +  - reg-names | ||||
| +  - clocks | ||||
| +  - clock-names | ||||
| + | ||||
| +examples: | ||||
| +  - | | ||||
| +    nficlock: nficlock { | ||||
| +    	#clock-cells = <0>; | ||||
| +    	compatible = "fixed-clock"; | ||||
| + | ||||
| +    	clock-frequency = <125000000>; | ||||
| +    }; | ||||
| + | ||||
| +    nand@1e003000 { | ||||
| +    	compatible = "mediatek,mt7621-nfc"; | ||||
| + | ||||
| +    	reg = <0x1e003000 0x800 | ||||
| +    	       0x1e003800 0x800>; | ||||
| +    	reg-names = "nfi", "ecc"; | ||||
| + | ||||
| +    	clocks = <&nficlock>; | ||||
| +    	clock-names = "nfi_clk"; | ||||
| +    }; | ||||
| @@ -0,0 +1,61 @@ | ||||
| There is a variant of MT7621 which contains only one CPU core instead of 2. | ||||
| This is not reflected in the config register, so the kernel detects more | ||||
| physical cores, which leads to a hang on SMP bringup. | ||||
| Add a hack to detect missing cores. | ||||
|  | ||||
| Signed-off-by: Felix Fietkau <nbd@nbd.name> | ||||
|  | ||||
| --- a/arch/mips/kernel/smp-cps.c | ||||
| +++ b/arch/mips/kernel/smp-cps.c | ||||
| @@ -43,6 +43,11 @@ static unsigned core_vpe_count(unsigned | ||||
|  	return mips_cps_numvps(cluster, core); | ||||
|  } | ||||
|   | ||||
| +bool __weak plat_cpu_core_present(int core) | ||||
| +{ | ||||
| +	return true; | ||||
| +} | ||||
| + | ||||
|  static void __init cps_smp_setup(void) | ||||
|  { | ||||
|  	unsigned int nclusters, ncores, nvpes, core_vpes; | ||||
| @@ -60,6 +65,8 @@ static void __init cps_smp_setup(void) | ||||
|   | ||||
|  		ncores = mips_cps_numcores(cl); | ||||
|  		for (c = 0; c < ncores; c++) { | ||||
| +			if (!plat_cpu_core_present(c)) | ||||
| +				continue; | ||||
|  			core_vpes = core_vpe_count(cl, c); | ||||
|   | ||||
|  			if (c > 0) | ||||
| --- a/arch/mips/ralink/mt7621.c | ||||
| +++ b/arch/mips/ralink/mt7621.c | ||||
| @@ -13,6 +13,7 @@ | ||||
|  #include <asm/mips-cps.h> | ||||
|  #include <asm/mach-ralink/ralink_regs.h> | ||||
|  #include <asm/mach-ralink/mt7621.h> | ||||
| +#include <asm/mips-boards/launch.h> | ||||
|   | ||||
|  #include <pinmux.h> | ||||
|   | ||||
| @@ -160,6 +161,20 @@ void __init ralink_of_remap(void) | ||||
|  		panic("Failed to remap core resources"); | ||||
|  } | ||||
|   | ||||
| +bool plat_cpu_core_present(int core) | ||||
| +{ | ||||
| +	struct cpulaunch *launch = (struct cpulaunch *)CKSEG0ADDR(CPULAUNCH); | ||||
| + | ||||
| +	if (!core) | ||||
| +		return true; | ||||
| +	launch += core * 2; /* 2 VPEs per core */ | ||||
| +	if (!(launch->flags & LAUNCH_FREADY)) | ||||
| +		return false; | ||||
| +	if (launch->flags & (LAUNCH_FGO | LAUNCH_FGONE)) | ||||
| +		return false; | ||||
| +	return true; | ||||
| +} | ||||
| + | ||||
|  void prom_soc_init(struct ralink_soc_info *soc_info) | ||||
|  { | ||||
|  	void __iomem *sysc = (void __iomem *) KSEG1ADDR(MT7621_SYSC_BASE); | ||||
							
								
								
									
										87
									
								
								target/linux/ramips/patches-5.10/101-mt7621-timer.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										87
									
								
								target/linux/ramips/patches-5.10/101-mt7621-timer.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,87 @@ | ||||
| --- a/arch/mips/ralink/mt7621.c | ||||
| +++ b/arch/mips/ralink/mt7621.c | ||||
| @@ -7,6 +7,7 @@ | ||||
|   | ||||
|  #include <linux/kernel.h> | ||||
|  #include <linux/init.h> | ||||
| +#include <linux/jiffies.h> | ||||
|   | ||||
|  #include <asm/mipsregs.h> | ||||
|  #include <asm/smp-ops.h> | ||||
| @@ -14,6 +15,7 @@ | ||||
|  #include <asm/mach-ralink/ralink_regs.h> | ||||
|  #include <asm/mach-ralink/mt7621.h> | ||||
|  #include <asm/mips-boards/launch.h> | ||||
| +#include <asm/delay.h> | ||||
|   | ||||
|  #include <pinmux.h> | ||||
|   | ||||
| @@ -175,6 +177,58 @@ bool plat_cpu_core_present(int core) | ||||
|  	return true; | ||||
|  } | ||||
|   | ||||
| +#define LPS_PREC 8 | ||||
| +/* | ||||
| +*  Re-calibration lpj(loop-per-jiffy). | ||||
| +*  (derived from kernel/calibrate.c) | ||||
| +*/ | ||||
| +static int udelay_recal(void) | ||||
| +{ | ||||
| +	unsigned int i, lpj = 0; | ||||
| +	unsigned long ticks, loopbit; | ||||
| +	int lps_precision = LPS_PREC; | ||||
| + | ||||
| +	lpj = (1<<12); | ||||
| + | ||||
| +	while ((lpj <<= 1) != 0) { | ||||
| +		/* wait for "start of" clock tick */ | ||||
| +		ticks = jiffies; | ||||
| +		while (ticks == jiffies) | ||||
| +			/* nothing */; | ||||
| + | ||||
| +		/* Go .. */ | ||||
| +		ticks = jiffies; | ||||
| +		__delay(lpj); | ||||
| +		ticks = jiffies - ticks; | ||||
| +		if (ticks) | ||||
| +			break; | ||||
| +	} | ||||
| + | ||||
| +	/* | ||||
| +	 * Do a binary approximation to get lpj set to | ||||
| +	 * equal one clock (up to lps_precision bits) | ||||
| +	 */ | ||||
| +	lpj >>= 1; | ||||
| +	loopbit = lpj; | ||||
| +	while (lps_precision-- && (loopbit >>= 1)) { | ||||
| +		lpj |= loopbit; | ||||
| +		ticks = jiffies; | ||||
| +		while (ticks == jiffies) | ||||
| +			/* nothing */; | ||||
| +		ticks = jiffies; | ||||
| +		__delay(lpj); | ||||
| +		if (jiffies != ticks)   /* longer than 1 tick */ | ||||
| +			lpj &= ~loopbit; | ||||
| +	} | ||||
| +	printk(KERN_INFO "%d CPUs re-calibrate udelay(lpj = %d)\n", NR_CPUS, lpj); | ||||
| + | ||||
| +	for(i=0; i< NR_CPUS; i++) | ||||
| +		cpu_data[i].udelay_val = lpj; | ||||
| + | ||||
| +	return 0; | ||||
| +} | ||||
| +device_initcall(udelay_recal); | ||||
| + | ||||
|  void prom_soc_init(struct ralink_soc_info *soc_info) | ||||
|  { | ||||
|  	void __iomem *sysc = (void __iomem *) KSEG1ADDR(MT7621_SYSC_BASE); | ||||
| --- a/arch/mips/ralink/Kconfig | ||||
| +++ b/arch/mips/ralink/Kconfig | ||||
| @@ -58,6 +58,7 @@ choice | ||||
|  		select CLKSRC_MIPS_GIC | ||||
|  		select HAVE_PCI if PCI_MT7621 | ||||
|  		select WEAK_REORDERING_BEYOND_LLSC | ||||
| +		select GENERIC_CLOCKEVENTS_BROADCAST | ||||
|  endchoice | ||||
|   | ||||
|  choice | ||||
| @@ -0,0 +1,224 @@ | ||||
| --- a/arch/mips/include/asm/mach-ralink/mt7621.h | ||||
| +++ b/arch/mips/include/asm/mach-ralink/mt7621.h | ||||
| @@ -17,6 +17,10 @@ | ||||
|  #define SYSC_REG_CHIP_REV		0x0c | ||||
|  #define SYSC_REG_SYSTEM_CONFIG0		0x10 | ||||
|  #define SYSC_REG_SYSTEM_CONFIG1		0x14 | ||||
| +#define SYSC_REG_CLKCFG0		0x2c | ||||
| +#define SYSC_REG_CUR_CLK_STS		0x44 | ||||
| + | ||||
| +#define MEMC_REG_CPU_PLL		0x648 | ||||
|   | ||||
|  #define CHIP_REV_PKG_MASK		0x1 | ||||
|  #define CHIP_REV_PKG_SHIFT		16 | ||||
| @@ -24,6 +28,22 @@ | ||||
|  #define CHIP_REV_VER_SHIFT		8 | ||||
|  #define CHIP_REV_ECO_MASK		0xf | ||||
|   | ||||
| +#define XTAL_MODE_SEL_MASK		0x7 | ||||
| +#define XTAL_MODE_SEL_SHIFT		6 | ||||
| + | ||||
| +#define CPU_CLK_SEL_MASK		0x3 | ||||
| +#define CPU_CLK_SEL_SHIFT		30 | ||||
| + | ||||
| +#define CUR_CPU_FDIV_MASK		0x1f | ||||
| +#define CUR_CPU_FDIV_SHIFT		8 | ||||
| +#define CUR_CPU_FFRAC_MASK		0x1f | ||||
| +#define CUR_CPU_FFRAC_SHIFT		0 | ||||
| + | ||||
| +#define CPU_PLL_PREDIV_MASK		0x3 | ||||
| +#define CPU_PLL_PREDIV_SHIFT		12 | ||||
| +#define CPU_PLL_FBDIV_MASK		0x7f | ||||
| +#define CPU_PLL_FBDIV_SHIFT		4 | ||||
| + | ||||
|  #define MT7621_DRAM_BASE                0x0 | ||||
|  #define MT7621_DDR2_SIZE_MIN		32 | ||||
|  #define MT7621_DDR2_SIZE_MAX		256 | ||||
| --- a/arch/mips/ralink/mt7621.c | ||||
| +++ b/arch/mips/ralink/mt7621.c | ||||
| @@ -8,6 +8,10 @@ | ||||
|  #include <linux/kernel.h> | ||||
|  #include <linux/init.h> | ||||
|  #include <linux/jiffies.h> | ||||
| +#include <linux/clk.h> | ||||
| +#include <linux/clkdev.h> | ||||
| +#include <linux/clk-provider.h> | ||||
| +#include <dt-bindings/clock/mt7621-clk.h> | ||||
|   | ||||
|  #include <asm/mipsregs.h> | ||||
|  #include <asm/smp-ops.h> | ||||
| @@ -16,16 +20,12 @@ | ||||
|  #include <asm/mach-ralink/mt7621.h> | ||||
|  #include <asm/mips-boards/launch.h> | ||||
|  #include <asm/delay.h> | ||||
| +#include <asm/time.h> | ||||
|   | ||||
|  #include <pinmux.h> | ||||
|   | ||||
|  #include "common.h" | ||||
|   | ||||
| -#define SYSC_REG_SYSCFG		0x10 | ||||
| -#define SYSC_REG_CPLL_CLKCFG0	0x2c | ||||
| -#define SYSC_REG_CUR_CLK_STS	0x44 | ||||
| -#define CPU_CLK_SEL		(BIT(30) | BIT(31)) | ||||
| - | ||||
|  #define MT7621_GPIO_MODE_UART1		1 | ||||
|  #define MT7621_GPIO_MODE_I2C		2 | ||||
|  #define MT7621_GPIO_MODE_UART3_MASK	0x3 | ||||
| @@ -111,49 +111,89 @@ static struct rt2880_pmx_group mt7621_pi | ||||
|  	{ 0 } | ||||
|  }; | ||||
|   | ||||
| +static struct clk *clks[MT7621_CLK_MAX]; | ||||
| +static struct clk_onecell_data clk_data = { | ||||
| +	.clks = clks, | ||||
| +	.clk_num = ARRAY_SIZE(clks), | ||||
| +}; | ||||
| + | ||||
|  phys_addr_t mips_cpc_default_phys_base(void) | ||||
|  { | ||||
|  	panic("Cannot detect cpc address"); | ||||
|  } | ||||
|   | ||||
| -void __init ralink_clk_init(void) | ||||
| +static struct clk *__init mt7621_add_sys_clkdev( | ||||
| +	const char *id, unsigned long rate) | ||||
|  { | ||||
| -	int cpu_fdiv = 0; | ||||
| -	int cpu_ffrac = 0; | ||||
| -	int fbdiv = 0; | ||||
| -	u32 clk_sts, syscfg; | ||||
| -	u8 clk_sel = 0, xtal_mode; | ||||
| -	u32 cpu_clk; | ||||
| +	struct clk *clk; | ||||
| +	int err; | ||||
| + | ||||
| +	clk = clk_register_fixed_rate(NULL, id, NULL, 0, rate); | ||||
| +	if (IS_ERR(clk)) | ||||
| +		panic("failed to allocate %s clock structure", id); | ||||
| + | ||||
| +	err = clk_register_clkdev(clk, id, NULL); | ||||
| +	if (err) | ||||
| +		panic("unable to register %s clock device", id); | ||||
|   | ||||
| -	if ((rt_sysc_r32(SYSC_REG_CPLL_CLKCFG0) & CPU_CLK_SEL) != 0) | ||||
| -		clk_sel = 1; | ||||
| +	return clk; | ||||
| +} | ||||
| + | ||||
| +void __init ralink_clk_init(void) | ||||
| +{ | ||||
| +	u32 syscfg, xtal_sel, clkcfg, clk_sel, curclk, ffiv, ffrac; | ||||
| +	u32 pll, prediv, fbdiv; | ||||
| +	u32 xtal_clk, cpu_clk, bus_clk; | ||||
| +	const static u32 prediv_tbl[] = {0, 1, 2, 2}; | ||||
| + | ||||
| +	syscfg = rt_sysc_r32(SYSC_REG_SYSTEM_CONFIG0); | ||||
| +	xtal_sel = (syscfg >> XTAL_MODE_SEL_SHIFT) & XTAL_MODE_SEL_MASK; | ||||
| + | ||||
| +	clkcfg = rt_sysc_r32(SYSC_REG_CLKCFG0); | ||||
| +	clk_sel = (clkcfg >> CPU_CLK_SEL_SHIFT) & CPU_CLK_SEL_MASK; | ||||
| + | ||||
| +	curclk = rt_sysc_r32(SYSC_REG_CUR_CLK_STS); | ||||
| +	ffiv = (curclk >> CUR_CPU_FDIV_SHIFT) & CUR_CPU_FDIV_MASK; | ||||
| +	ffrac = (curclk >> CUR_CPU_FFRAC_SHIFT) & CUR_CPU_FFRAC_MASK; | ||||
| + | ||||
| +	if (xtal_sel <= 2) | ||||
| +		xtal_clk = 20 * 1000 * 1000; | ||||
| +	else if (xtal_sel <= 5) | ||||
| +		xtal_clk = 40 * 1000 * 1000; | ||||
| +	else | ||||
| +		xtal_clk = 25 * 1000 * 1000; | ||||
|   | ||||
|  	switch (clk_sel) { | ||||
|  	case 0: | ||||
| -		clk_sts = rt_sysc_r32(SYSC_REG_CUR_CLK_STS); | ||||
| -		cpu_fdiv = ((clk_sts >> 8) & 0x1F); | ||||
| -		cpu_ffrac = (clk_sts & 0x1F); | ||||
| -		cpu_clk = (500 * cpu_ffrac / cpu_fdiv) * 1000 * 1000; | ||||
| +		cpu_clk = 500 * 1000 * 1000; | ||||
|  		break; | ||||
| - | ||||
|  	case 1: | ||||
| -		fbdiv = ((rt_sysc_r32(0x648) >> 4) & 0x7F) + 1; | ||||
| -		syscfg = rt_sysc_r32(SYSC_REG_SYSCFG); | ||||
| -		xtal_mode = (syscfg >> 6) & 0x7; | ||||
| -		if (xtal_mode >= 6) { | ||||
| -			/* 25Mhz Xtal */ | ||||
| -			cpu_clk = 25 * fbdiv * 1000 * 1000; | ||||
| -		} else if (xtal_mode >= 3) { | ||||
| -			/* 40Mhz Xtal */ | ||||
| -			cpu_clk = 40 * fbdiv * 1000 * 1000; | ||||
| -		} else { | ||||
| -			/* 20Mhz Xtal */ | ||||
| -			cpu_clk = 20 * fbdiv * 1000 * 1000; | ||||
| -		} | ||||
| +		pll = rt_memc_r32(MEMC_REG_CPU_PLL); | ||||
| +		fbdiv = (pll >> CPU_PLL_FBDIV_SHIFT) & CPU_PLL_FBDIV_MASK; | ||||
| +		prediv = (pll >> CPU_PLL_PREDIV_SHIFT) & CPU_PLL_PREDIV_MASK; | ||||
| +		cpu_clk = ((fbdiv + 1) * xtal_clk) >> prediv_tbl[prediv]; | ||||
|  		break; | ||||
| +	default: | ||||
| +		cpu_clk = xtal_clk; | ||||
|  	} | ||||
| + | ||||
| +	cpu_clk = cpu_clk / ffiv * ffrac; | ||||
| +	bus_clk = cpu_clk / 4; | ||||
| + | ||||
| +	clks[MT7621_CLK_CPU] = mt7621_add_sys_clkdev("cpu", cpu_clk); | ||||
| +	clks[MT7621_CLK_BUS] = mt7621_add_sys_clkdev("bus", bus_clk); | ||||
| + | ||||
| +	pr_info("CPU Clock: %dMHz\n", cpu_clk / 1000000); | ||||
| +	mips_hpt_frequency = cpu_clk / 2; | ||||
|  } | ||||
|   | ||||
| +static void __init mt7621_clocks_init_dt(struct device_node *np) | ||||
| +{ | ||||
| +	of_clk_add_provider(np, of_clk_src_onecell_get, &clk_data); | ||||
| +} | ||||
| + | ||||
| +CLK_OF_DECLARE(ar7100, "mediatek,mt7621-pll", mt7621_clocks_init_dt); | ||||
| + | ||||
|  void __init ralink_of_remap(void) | ||||
|  { | ||||
|  	rt_sysc_membase = plat_of_remap_node("mtk,mt7621-sysc"); | ||||
| --- a/arch/mips/ralink/timer-gic.c | ||||
| +++ b/arch/mips/ralink/timer-gic.c | ||||
| @@ -9,14 +9,14 @@ | ||||
|   | ||||
|  #include <linux/of.h> | ||||
|  #include <linux/clk-provider.h> | ||||
| -#include <linux/clocksource.h> | ||||
| +#include <asm/time.h> | ||||
|   | ||||
|  #include "common.h" | ||||
|   | ||||
|  void __init plat_time_init(void) | ||||
|  { | ||||
|  	ralink_of_remap(); | ||||
| - | ||||
| +	ralink_clk_init(); | ||||
|  	of_clk_init(NULL); | ||||
|  	timer_probe(); | ||||
|  } | ||||
| --- /dev/null | ||||
| +++ b/include/dt-bindings/clock/mt7621-clk.h | ||||
| @@ -0,0 +1,18 @@ | ||||
| +/* | ||||
| + * Copyright (C) 2018 Weijie Gao <hackpascal@gmail.com> | ||||
| + * | ||||
| + * This program is free software; you can redistribute it and/or modify | ||||
| + * it under the terms of the GNU General Public License version 2 as | ||||
| + * published by the Free Software Foundation. | ||||
| + * | ||||
| + */ | ||||
| + | ||||
| +#ifndef __DT_BINDINGS_MT7621_CLK_H | ||||
| +#define __DT_BINDINGS_MT7621_CLK_H | ||||
| + | ||||
| +#define MT7621_CLK_CPU		0 | ||||
| +#define MT7621_CLK_BUS		1 | ||||
| + | ||||
| +#define MT7621_CLK_MAX		2 | ||||
| + | ||||
| +#endif /* __DT_BINDINGS_MT7621_CLK_H */ | ||||
							
								
								
									
										125
									
								
								target/linux/ramips/patches-5.10/105-mt7621-memory-detect.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										125
									
								
								target/linux/ramips/patches-5.10/105-mt7621-memory-detect.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,125 @@ | ||||
| From b5a52351a66f3c2a7a207548aa87d78ff2d336c0 Mon Sep 17 00:00:00 2001 | ||||
| From: Chuanhong Guo <gch981213@gmail.com> | ||||
| Date: Wed, 10 Jul 2019 00:24:48 +0800 | ||||
| Subject: [PATCH] MIPS: ralink: mt7621: add memory detection support | ||||
|  | ||||
| mt7621 has the following memory map: | ||||
| 0x0-0x1c000000: lower 448m memory | ||||
| 0x1c000000-0x2000000: peripheral registers | ||||
| 0x20000000-0x2400000: higher 64m memory | ||||
|  | ||||
| detect_memory_region in arch/mips/kernel/setup.c only add the first | ||||
| memory region and isn't suitable for 512m memory detection because | ||||
| it may accidentally read the memory area for peripheral registers. | ||||
|  | ||||
| This commit adds memory detection capability for mt7621: | ||||
| 1. add the highmem area when 512m is detected. | ||||
| 2. guard memcmp from accessing peripheral registers: | ||||
|      This only happens when some weird user decided to change | ||||
|      kernel load address to 256m or higher address. Since this | ||||
|      is a quite unusual case, we just skip 512m testing and return | ||||
|      256m as memory size. | ||||
|  | ||||
| Signed-off-by: Chuanhong Guo <gch981213@gmail.com> | ||||
| --- | ||||
|  arch/mips/include/asm/mach-ralink/mt7621.h |  7 ++--- | ||||
|  arch/mips/ralink/mt7621.c                  | 30 +++++++++++++++++++--- | ||||
|  2 files changed, 30 insertions(+), 7 deletions(-) | ||||
|  | ||||
| --- a/arch/mips/include/asm/mach-ralink/mt7621.h | ||||
| +++ b/arch/mips/include/asm/mach-ralink/mt7621.h | ||||
| @@ -44,9 +44,10 @@ | ||||
|  #define CPU_PLL_FBDIV_MASK		0x7f | ||||
|  #define CPU_PLL_FBDIV_SHIFT		4 | ||||
|   | ||||
| -#define MT7621_DRAM_BASE                0x0 | ||||
| -#define MT7621_DDR2_SIZE_MIN		32 | ||||
| -#define MT7621_DDR2_SIZE_MAX		256 | ||||
| +#define MT7621_LOWMEM_BASE		0x0 | ||||
| +#define MT7621_LOWMEM_MAX_SIZE		0x1C000000 | ||||
| +#define MT7621_HIGHMEM_BASE		0x20000000 | ||||
| +#define MT7621_HIGHMEM_SIZE		0x4000000 | ||||
|   | ||||
|  #define MT7621_CHIP_NAME0		0x3637544D | ||||
|  #define MT7621_CHIP_NAME1		0x20203132 | ||||
| --- a/arch/mips/ralink/mt7621.c | ||||
| +++ b/arch/mips/ralink/mt7621.c | ||||
| @@ -13,6 +13,7 @@ | ||||
|  #include <linux/clk-provider.h> | ||||
|  #include <dt-bindings/clock/mt7621-clk.h> | ||||
|   | ||||
| +#include <asm/bootinfo.h> | ||||
|  #include <asm/mipsregs.h> | ||||
|  #include <asm/smp-ops.h> | ||||
|  #include <asm/mips-cps.h> | ||||
| @@ -55,6 +56,8 @@ | ||||
|  #define MT7621_GPIO_MODE_SDHCI_SHIFT	18 | ||||
|  #define MT7621_GPIO_MODE_SDHCI_GPIO	1 | ||||
|   | ||||
| +static void *detect_magic __initdata = detect_memory_region; | ||||
| + | ||||
|  static struct rt2880_pmx_func uart1_grp[] =  { FUNC("uart1", 0, 1, 2) }; | ||||
|  static struct rt2880_pmx_func i2c_grp[] =  { FUNC("i2c", 0, 3, 2) }; | ||||
|  static struct rt2880_pmx_func uart3_grp[] = { | ||||
| @@ -139,6 +142,28 @@ static struct clk *__init mt7621_add_sys | ||||
|  	return clk; | ||||
|  } | ||||
|   | ||||
| +void __init mt7621_memory_detect(void) | ||||
| +{ | ||||
| +	void *dm = &detect_magic; | ||||
| +	phys_addr_t size; | ||||
| + | ||||
| +	for (size = 32 * SZ_1M; size < 256 * SZ_1M; size <<= 1) { | ||||
| +		if (!memcmp(dm, dm + size, sizeof(detect_magic))) | ||||
| +			break; | ||||
| +	} | ||||
| + | ||||
| +	if ((size == 256 * SZ_1M) && | ||||
| +	    (CPHYSADDR(dm + size) < MT7621_LOWMEM_MAX_SIZE) && | ||||
| +	    memcmp(dm, dm + size, sizeof(detect_magic))) { | ||||
| +		add_memory_region(MT7621_LOWMEM_BASE, MT7621_LOWMEM_MAX_SIZE, | ||||
| +				  BOOT_MEM_RAM); | ||||
| +		add_memory_region(MT7621_HIGHMEM_BASE, MT7621_HIGHMEM_SIZE, | ||||
| +				  BOOT_MEM_RAM); | ||||
| +	} else { | ||||
| +		add_memory_region(MT7621_LOWMEM_BASE, size, BOOT_MEM_RAM); | ||||
| +	} | ||||
| +} | ||||
| + | ||||
|  void __init ralink_clk_init(void) | ||||
|  { | ||||
|  	u32 syscfg, xtal_sel, clkcfg, clk_sel, curclk, ffiv, ffrac; | ||||
| @@ -317,10 +342,7 @@ void prom_soc_init(struct ralink_soc_inf | ||||
|  		(rev >> CHIP_REV_VER_SHIFT) & CHIP_REV_VER_MASK, | ||||
|  		(rev & CHIP_REV_ECO_MASK)); | ||||
|   | ||||
| -	soc_info->mem_size_min = MT7621_DDR2_SIZE_MIN; | ||||
| -	soc_info->mem_size_max = MT7621_DDR2_SIZE_MAX; | ||||
| -	soc_info->mem_base = MT7621_DRAM_BASE; | ||||
| - | ||||
| +	soc_info->mem_detect = mt7621_memory_detect; | ||||
|  	rt2880_pinmux_data = mt7621_pinmux_data; | ||||
|   | ||||
|   | ||||
| --- a/arch/mips/ralink/common.h | ||||
| +++ b/arch/mips/ralink/common.h | ||||
| @@ -17,6 +17,7 @@ struct ralink_soc_info { | ||||
|  	unsigned long mem_size; | ||||
|  	unsigned long mem_size_min; | ||||
|  	unsigned long mem_size_max; | ||||
| +	void (*mem_detect)(void); | ||||
|  }; | ||||
|  extern struct ralink_soc_info soc_info; | ||||
|   | ||||
| --- a/arch/mips/ralink/of.c | ||||
| +++ b/arch/mips/ralink/of.c | ||||
| @@ -87,6 +87,8 @@ void __init plat_mem_setup(void) | ||||
|  	of_scan_flat_dt(early_init_dt_find_memory, NULL); | ||||
|  	if (memory_dtb) | ||||
|  		of_scan_flat_dt(early_init_dt_scan_memory, NULL); | ||||
| +	else if (soc_info.mem_detect) | ||||
| +		soc_info.mem_detect(); | ||||
|  	else if (soc_info.mem_size) | ||||
|  		add_memory_region(soc_info.mem_base, soc_info.mem_size * SZ_1M, | ||||
|  				  BOOT_MEM_RAM); | ||||
| @@ -0,0 +1,15 @@ | ||||
| --- a/arch/mips/ralink/irq-gic.c | ||||
| +++ b/arch/mips/ralink/irq-gic.c | ||||
| @@ -13,6 +13,12 @@ | ||||
|   | ||||
|  int get_c0_perfcount_int(void) | ||||
|  { | ||||
| +	/* | ||||
| +	 * Performance counter events are routed through GIC. | ||||
| +	 * Prevent them from firing on CPU IRQ7 as well | ||||
| +	 */ | ||||
| +	clear_c0_status(IE_SW0 << 7); | ||||
| + | ||||
|  	return gic_get_c0_perfcount_int(); | ||||
|  } | ||||
|  EXPORT_SYMBOL_GPL(get_c0_perfcount_int); | ||||
| @@ -0,0 +1,85 @@ | ||||
| From 5d7b644aad721ecca20bd8976b38fb243fdc84f9 Mon Sep 17 00:00:00 2001 | ||||
| From: Chuanhong Guo <gch981213@gmail.com> | ||||
| Date: Sun, 15 Mar 2020 20:13:37 +0800 | ||||
| Subject: [PATCH] gpio: mmio: introduce BGPIOF_NO_SET_ON_INPUT | ||||
| MIME-Version: 1.0 | ||||
| Content-Type: text/plain; charset=UTF-8 | ||||
| Content-Transfer-Encoding: 8bit | ||||
|  | ||||
| Some gpio controllers ignores pin value writing when that pin is | ||||
| configured as input mode. As a result, bgpio_dir_out should set | ||||
| pin to output before configuring pin values or gpio pin values | ||||
| can't be set up properly. | ||||
| Introduce two variants of bgpio_dir_out: bgpio_dir_out_val_first | ||||
| and bgpio_dir_out_dir_first, and assign direction_output according | ||||
| to a new flag: BGPIOF_NO_SET_ON_INPUT. | ||||
|  | ||||
| Signed-off-by: Chuanhong Guo <gch981213@gmail.com> | ||||
| Tested-by: René van Dorst <opensource@vdorst.com> | ||||
| Reviewed-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Signed-off-by: Bartosz Golaszewski <bgolaszewski@baylibre.com> | ||||
| --- | ||||
|  drivers/gpio/gpio-mmio.c    | 23 +++++++++++++++++++---- | ||||
|  include/linux/gpio/driver.h |  1 + | ||||
|  2 files changed, 20 insertions(+), 4 deletions(-) | ||||
|  | ||||
| --- a/drivers/gpio/gpio-mmio.c | ||||
| +++ b/drivers/gpio/gpio-mmio.c | ||||
| @@ -381,12 +381,10 @@ static int bgpio_get_dir(struct gpio_chi | ||||
|  	return 1; | ||||
|  } | ||||
|   | ||||
| -static int bgpio_dir_out(struct gpio_chip *gc, unsigned int gpio, int val) | ||||
| +static void bgpio_dir_out(struct gpio_chip *gc, unsigned int gpio, int val) | ||||
|  { | ||||
|  	unsigned long flags; | ||||
|   | ||||
| -	gc->set(gc, gpio, val); | ||||
| - | ||||
|  	spin_lock_irqsave(&gc->bgpio_lock, flags); | ||||
|   | ||||
|  	gc->bgpio_dir |= bgpio_line2mask(gc, gpio); | ||||
| @@ -397,7 +395,21 @@ static int bgpio_dir_out(struct gpio_chi | ||||
|  		gc->write_reg(gc->reg_dir_out, gc->bgpio_dir); | ||||
|   | ||||
|  	spin_unlock_irqrestore(&gc->bgpio_lock, flags); | ||||
| +} | ||||
|   | ||||
| +static int bgpio_dir_out_dir_first(struct gpio_chip *gc, unsigned int gpio, | ||||
| +				   int val) | ||||
| +{ | ||||
| +	bgpio_dir_out(gc, gpio, val); | ||||
| +	gc->set(gc, gpio, val); | ||||
| +	return 0; | ||||
| +} | ||||
| + | ||||
| +static int bgpio_dir_out_val_first(struct gpio_chip *gc, unsigned int gpio, | ||||
| +				   int val) | ||||
| +{ | ||||
| +	gc->set(gc, gpio, val); | ||||
| +	bgpio_dir_out(gc, gpio, val); | ||||
|  	return 0; | ||||
|  } | ||||
|   | ||||
| @@ -530,7 +542,10 @@ static int bgpio_setup_direction(struct | ||||
|  	if (dirout || dirin) { | ||||
|  		gc->reg_dir_out = dirout; | ||||
|  		gc->reg_dir_in = dirin; | ||||
| -		gc->direction_output = bgpio_dir_out; | ||||
| +		if (flags & BGPIOF_NO_SET_ON_INPUT) | ||||
| +			gc->direction_output = bgpio_dir_out_dir_first; | ||||
| +		else | ||||
| +			gc->direction_output = bgpio_dir_out_val_first; | ||||
|  		gc->direction_input = bgpio_dir_in; | ||||
|  		gc->get_direction = bgpio_get_dir; | ||||
|  	} else { | ||||
| --- a/include/linux/gpio/driver.h | ||||
| +++ b/include/linux/gpio/driver.h | ||||
| @@ -567,6 +567,7 @@ int bgpio_init(struct gpio_chip *gc, str | ||||
|  #define BGPIOF_BIG_ENDIAN_BYTE_ORDER	BIT(3) | ||||
|  #define BGPIOF_READ_OUTPUT_REG_SET	BIT(4) /* reg_set stores output value */ | ||||
|  #define BGPIOF_NO_OUTPUT		BIT(5) /* only input */ | ||||
| +#define BGPIOF_NO_SET_ON_INPUT		BIT(6) | ||||
|   | ||||
|  int gpiochip_irq_map(struct irq_domain *d, unsigned int irq, | ||||
|  		     irq_hw_number_t hwirq); | ||||
| @@ -0,0 +1,33 @@ | ||||
| From ad65f02fd73e9a700f1693a4513ae923ca07beb0 Mon Sep 17 00:00:00 2001 | ||||
| From: Chuanhong Guo <gch981213@gmail.com> | ||||
| Date: Sun, 15 Mar 2020 20:13:38 +0800 | ||||
| Subject: [PATCH] gpio: mt7621: add BGPIOF_NO_SET_ON_INPUT flag | ||||
| MIME-Version: 1.0 | ||||
| Content-Type: text/plain; charset=UTF-8 | ||||
| Content-Transfer-Encoding: 8bit | ||||
|  | ||||
| DSET/DCLR registers only works on output pins. Add corresponding | ||||
| BGPIOF_NO_SET_ON_INPUT flag to bgpio_init call to fix direction_out | ||||
| behavior. | ||||
|  | ||||
| Signed-off-by: Chuanhong Guo <gch981213@gmail.com> | ||||
| Tested-by: René van Dorst <opensource@vdorst.com> | ||||
| Reviewed-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Signed-off-by: Bartosz Golaszewski <bgolaszewski@baylibre.com> | ||||
| --- | ||||
|  drivers/gpio/gpio-mt7621.c | 4 ++-- | ||||
|  1 file changed, 2 insertions(+), 2 deletions(-) | ||||
|  | ||||
| --- a/drivers/gpio/gpio-mt7621.c | ||||
| +++ b/drivers/gpio/gpio-mt7621.c | ||||
| @@ -227,8 +227,8 @@ mediatek_gpio_bank_probe(struct device * | ||||
|  	ctrl = mtk->base + GPIO_REG_DCLR + (rg->bank * GPIO_BANK_STRIDE); | ||||
|  	diro = mtk->base + GPIO_REG_CTRL + (rg->bank * GPIO_BANK_STRIDE); | ||||
|   | ||||
| -	ret = bgpio_init(&rg->chip, dev, 4, | ||||
| -			 dat, set, ctrl, diro, NULL, 0); | ||||
| +	ret = bgpio_init(&rg->chip, dev, 4, dat, set, ctrl, diro, NULL, | ||||
| +			 BGPIOF_NO_SET_ON_INPUT); | ||||
|  	if (ret) { | ||||
|  		dev_err(dev, "bgpio_init() failed\n"); | ||||
|  		return ret; | ||||
							
								
								
									
										20
									
								
								target/linux/ramips/patches-5.10/200-add-ralink-eth.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										20
									
								
								target/linux/ramips/patches-5.10/200-add-ralink-eth.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,20 @@ | ||||
| --- a/drivers/net/ethernet/Kconfig | ||||
| +++ b/drivers/net/ethernet/Kconfig | ||||
| @@ -159,6 +159,7 @@ source "drivers/net/ethernet/pasemi/Kcon | ||||
|  source "drivers/net/ethernet/pensando/Kconfig" | ||||
|  source "drivers/net/ethernet/qlogic/Kconfig" | ||||
|  source "drivers/net/ethernet/qualcomm/Kconfig" | ||||
| +source "drivers/net/ethernet/ralink/Kconfig" | ||||
|  source "drivers/net/ethernet/rdc/Kconfig" | ||||
|  source "drivers/net/ethernet/realtek/Kconfig" | ||||
|  source "drivers/net/ethernet/renesas/Kconfig" | ||||
| --- a/drivers/net/ethernet/Makefile | ||||
| +++ b/drivers/net/ethernet/Makefile | ||||
| @@ -72,6 +72,7 @@ obj-$(CONFIG_NET_VENDOR_PACKET_ENGINES) | ||||
|  obj-$(CONFIG_NET_VENDOR_PASEMI) += pasemi/ | ||||
|  obj-$(CONFIG_NET_VENDOR_QLOGIC) += qlogic/ | ||||
|  obj-$(CONFIG_NET_VENDOR_QUALCOMM) += qualcomm/ | ||||
| +obj-$(CONFIG_NET_VENDOR_RALINK) += ralink/ | ||||
|  obj-$(CONFIG_NET_VENDOR_REALTEK) += realtek/ | ||||
|  obj-$(CONFIG_NET_VENDOR_RENESAS) += renesas/ | ||||
|  obj-$(CONFIG_NET_VENDOR_RDC) += rdc/ | ||||
| @@ -0,0 +1,19 @@ | ||||
| --- a/arch/mips/include/asm/mach-ralink/mt7620.h | ||||
| +++ b/arch/mips/include/asm/mach-ralink/mt7620.h | ||||
| @@ -135,4 +135,16 @@ static inline int mt7620_get_eco(void) | ||||
|  	return rt_sysc_r32(SYSC_REG_CHIP_REV) & CHIP_REV_ECO_MASK; | ||||
|  } | ||||
|   | ||||
| +static inline int mt7620_get_chipver(void) | ||||
| +{ | ||||
| +	return (rt_sysc_r32(SYSC_REG_CHIP_REV) >> CHIP_REV_VER_SHIFT) & | ||||
| +		CHIP_REV_VER_MASK; | ||||
| +} | ||||
| + | ||||
| +static inline int mt7620_get_pkg(void) | ||||
| +{ | ||||
| +	return (rt_sysc_r32(SYSC_REG_CHIP_REV) >> CHIP_REV_PKG_SHIFT) & | ||||
| +		CHIP_REV_PKG_MASK; | ||||
| +} | ||||
| + | ||||
|  #endif | ||||
| @@ -0,0 +1,89 @@ | ||||
| From f798b7588bd7397bbab958281ca6c88d08714941 Mon Sep 17 00:00:00 2001 | ||||
| From: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Date: Thu, 12 Mar 2020 12:29:15 +0100 | ||||
| Subject: [PATCH] MIPS: ralink: mt7621: introduce 'soc_device' initialization | ||||
|  | ||||
| mt7621 SoC has its own 'ralink_soc_info' structure with some | ||||
| information about the soc itself. Pcie controller and pcie phy | ||||
| drivers for this soc which are still in staging git tree make uses | ||||
| of 'soc_device_attribute' looking for revision 'E2' in order to | ||||
| know if reset lines are or not inverted. This way of doing things | ||||
| seems to be necessary in order to make things clean and properly. | ||||
| Hence, introduce this 'soc_device' to be able to properly use those | ||||
| attributes in drivers. Also set 'data' pointer points to the struct | ||||
| 'ralink_soc_info' to be able to export also current soc information | ||||
| using this mechanism. | ||||
|  | ||||
| Cc: Paul Burton <paul.burton@mips.com> | ||||
| Cc: ralf@linux-mips.org | ||||
| Cc: jhogan@kernel.org | ||||
| Cc: john@phrozen.org | ||||
| Cc: NeilBrown <neil@brown.name> | ||||
| Cc: Greg Kroah-Hartman <gregkh@linuxfoundation.org> | ||||
| Cc: linux-mips@vger.kernel.org | ||||
|  | ||||
| Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> | ||||
| Signed-off-by: Thomas Bogendoerfer <tsbogend@alpha.franken.de> | ||||
| --- | ||||
|  arch/mips/ralink/mt7621.c | 32 +++++++++++++++++++++++++++++++- | ||||
|  1 file changed, 31 insertions(+), 1 deletion(-) | ||||
|  | ||||
| --- a/arch/mips/ralink/mt7621.c | ||||
| +++ b/arch/mips/ralink/mt7621.c | ||||
| @@ -7,6 +7,8 @@ | ||||
|   | ||||
|  #include <linux/kernel.h> | ||||
|  #include <linux/init.h> | ||||
| +#include <linux/slab.h> | ||||
| +#include <linux/sys_soc.h> | ||||
|  #include <linux/jiffies.h> | ||||
|  #include <linux/clk.h> | ||||
|  #include <linux/clkdev.h> | ||||
| @@ -294,6 +296,33 @@ static int udelay_recal(void) | ||||
|  } | ||||
|  device_initcall(udelay_recal); | ||||
|   | ||||
| +static void soc_dev_init(struct ralink_soc_info *soc_info, u32 rev) | ||||
| +{ | ||||
| +	struct soc_device *soc_dev; | ||||
| +	struct soc_device_attribute *soc_dev_attr; | ||||
| + | ||||
| +	soc_dev_attr = kzalloc(sizeof(*soc_dev_attr), GFP_KERNEL); | ||||
| +	if (!soc_dev_attr) | ||||
| +		return; | ||||
| + | ||||
| +	soc_dev_attr->soc_id = "mt7621"; | ||||
| +	soc_dev_attr->family = "Ralink"; | ||||
| + | ||||
| +	if (((rev >> CHIP_REV_VER_SHIFT) & CHIP_REV_VER_MASK) == 1 && | ||||
| +	    (rev & CHIP_REV_ECO_MASK) == 1) | ||||
| +		soc_dev_attr->revision = "E2"; | ||||
| +	else | ||||
| +		soc_dev_attr->revision = "E1"; | ||||
| + | ||||
| +	soc_dev_attr->data = soc_info; | ||||
| + | ||||
| +	soc_dev = soc_device_register(soc_dev_attr); | ||||
| +	if (IS_ERR(soc_dev)) { | ||||
| +		kfree(soc_dev_attr); | ||||
| +		return; | ||||
| +	} | ||||
| +} | ||||
| + | ||||
|  void prom_soc_init(struct ralink_soc_info *soc_info) | ||||
|  { | ||||
|  	void __iomem *sysc = (void __iomem *) KSEG1ADDR(MT7621_SYSC_BASE); | ||||
| @@ -345,11 +374,12 @@ void prom_soc_init(struct ralink_soc_inf | ||||
|  	soc_info->mem_detect = mt7621_memory_detect; | ||||
|  	rt2880_pinmux_data = mt7621_pinmux_data; | ||||
|   | ||||
| - | ||||
|  	if (!register_cps_smp_ops()) | ||||
|  		return; | ||||
|  	if (!register_cmp_smp_ops()) | ||||
|  		return; | ||||
|  	if (!register_vsmp_smp_ops()) | ||||
|  		return; | ||||
| + | ||||
| +	soc_dev_init(soc_info, rev); | ||||
|  } | ||||
| @@ -0,0 +1,14 @@ | ||||
| --- a/drivers/mtd/spi-nor/spi-nor.c | ||||
| +++ b/drivers/mtd/spi-nor/spi-nor.c | ||||
| @@ -2303,6 +2303,11 @@ static const struct flash_info spi_nor_i | ||||
|  			SPI_NOR_4B_OPCODES | SPI_NOR_HAS_LOCK | SPI_NOR_HAS_TB) | ||||
|  			.fixups = &gd25q256_fixups, | ||||
|  	}, | ||||
| +	{ | ||||
| +		"gd25q512", INFO(0xc84020, 0, 64 * 1024, 1024, | ||||
| +			SECT_4K | SPI_NOR_DUAL_READ | SPI_NOR_QUAD_READ | | ||||
| +			SPI_NOR_HAS_LOCK | SPI_NOR_HAS_TB | SPI_NOR_4B_OPCODES) | ||||
| +	}, | ||||
|   | ||||
|  	/* Intel/Numonyx -- xxxs33b */ | ||||
|  	{ "160s33b",  INFO(0x898911, 0, 64 * 1024,  32, 0) }, | ||||
| @@ -0,0 +1,34 @@ | ||||
| From bd0f89de5476ca25e73fae829ba3e1dafae1d90d Mon Sep 17 00:00:00 2001 | ||||
| From: =?UTF-8?q?Ren=C3=A9=20van=20Dorst?= <opensource@vdorst.com> | ||||
| Date: Fri, 21 Jun 2019 10:04:05 +0200 | ||||
| Subject: [PATCH] net: ethernet: mediatek: support net-labels | ||||
|  | ||||
| With this patch, device name can be set within dts file in the same way as dsa | ||||
| port can. | ||||
| Add: label = "wan"; to GMAC node. | ||||
|  | ||||
| Signed-off-by: René van Dorst <opensource@vdorst.com> | ||||
| --- | ||||
|  drivers/net/ethernet/mediatek/mtk_eth_soc.c | 4 ++++ | ||||
|  1 file changed, 4 insertions(+) | ||||
|  | ||||
| --- a/drivers/net/ethernet/mediatek/mtk_eth_soc.c | ||||
| +++ b/drivers/net/ethernet/mediatek/mtk_eth_soc.c | ||||
| @@ -2922,6 +2922,7 @@ static const struct net_device_ops mtk_n | ||||
|   | ||||
|  static int mtk_add_mac(struct mtk_eth *eth, struct device_node *np) | ||||
|  { | ||||
| +	const char *name = of_get_property(np, "label", NULL); | ||||
|  	const __be32 *_id = of_get_property(np, "reg", NULL); | ||||
|  	struct phylink *phylink; | ||||
|  	int phy_mode, id, err; | ||||
| @@ -3014,6 +3015,9 @@ static int mtk_add_mac(struct mtk_eth *e | ||||
|   | ||||
|  	eth->netdev[id]->max_mtu = MTK_MAX_RX_LENGTH - MTK_RX_ETH_HLEN; | ||||
|   | ||||
| +	if (name) | ||||
| +		strlcpy(eth->netdev[id]->name, name, IFNAMSIZ); | ||||
| + | ||||
|  	return 0; | ||||
|   | ||||
|  free_netdev: | ||||
| @@ -0,0 +1,47 @@ | ||||
| From 0b6eb1e68290243d439ee330ea8d0b239a5aec69 Mon Sep 17 00:00:00 2001 | ||||
| From: John Crispin <blogic@openwrt.org> | ||||
| Date: Sun, 27 Jul 2014 09:38:50 +0100 | ||||
| Subject: [PATCH 34/53] NET: multi phy support | ||||
|  | ||||
| Signed-off-by: John Crispin <blogic@openwrt.org> | ||||
| --- | ||||
|  drivers/net/phy/phy.c |    9 ++++++--- | ||||
|  include/linux/phy.h   |    1 + | ||||
|  2 files changed, 7 insertions(+), 3 deletions(-) | ||||
|  | ||||
| --- a/drivers/net/phy/phy.c | ||||
| +++ b/drivers/net/phy/phy.c | ||||
| @@ -546,7 +546,10 @@ static int phy_check_link_status(struct | ||||
|  		phy_link_up(phydev); | ||||
|  	} else if (!phydev->link && phydev->state != PHY_NOLINK) { | ||||
|  		phydev->state = PHY_NOLINK; | ||||
| -		phy_link_down(phydev, true); | ||||
| +		if (!phydev->no_auto_carrier_off) | ||||
| +			phy_link_down(phydev, true); | ||||
| +		else | ||||
| +			phy_link_down(phydev, false); | ||||
|  	} | ||||
|   | ||||
|  	return 0; | ||||
| @@ -926,7 +929,10 @@ void phy_state_machine(struct work_struc | ||||
|  	case PHY_HALTED: | ||||
|  		if (phydev->link) { | ||||
|  			phydev->link = 0; | ||||
| -			phy_link_down(phydev, true); | ||||
| +			if (!phydev->no_auto_carrier_off) | ||||
| +				phy_link_down(phydev, true); | ||||
| +			else | ||||
| +				phy_link_down(phydev, false); | ||||
|  		} | ||||
|  		do_suspend = true; | ||||
|  		break; | ||||
| --- a/include/linux/phy.h | ||||
| +++ b/include/linux/phy.h | ||||
| @@ -380,6 +380,7 @@ struct phy_device { | ||||
|  	unsigned suspended_by_mdio_bus:1; | ||||
|  	unsigned sysfs_links:1; | ||||
|  	unsigned loopback_enabled:1; | ||||
| +	unsigned no_auto_carrier_off:1; | ||||
|   | ||||
|  	unsigned autoneg:1; | ||||
|  	/* The most recently read link state */ | ||||
							
								
								
									
										156
									
								
								target/linux/ramips/patches-5.10/991-at803x.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										156
									
								
								target/linux/ramips/patches-5.10/991-at803x.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,156 @@ | ||||
| From 924453aa9d2324e5611f8e2b71df746d8f0c79f1 Mon Sep 17 00:00:00 2001 | ||||
| From: =?UTF-8?q?Ren=C3=A9=20van=20Dorst?= <opensource@vdorst.com> | ||||
| Date: Fri, 13 Nov 2020 16:11:32 +0100 | ||||
| Subject: [PATCH] net: phy: at803x: add support for SFP module in | ||||
|  RGMII-to-x-base mode | ||||
| MIME-Version: 1.0 | ||||
| Content-Type: text/plain; charset=UTF-8 | ||||
| Content-Transfer-Encoding: 8bit | ||||
|  | ||||
| Signed-off-by: René van Dorst <opensource@vdorst.com> | ||||
| --- | ||||
|  drivers/net/phy/at803x.c | 91 ++++++++++++++++++++++++++++++++++++++++ | ||||
|  1 file changed, 91 insertions(+) | ||||
|  | ||||
| --- a/drivers/net/phy/at803x.c | ||||
| +++ b/drivers/net/phy/at803x.c | ||||
| @@ -14,6 +14,8 @@ | ||||
|  #include <linux/etherdevice.h> | ||||
|  #include <linux/of_gpio.h> | ||||
|  #include <linux/gpio/consumer.h> | ||||
| +#include <linux/sfp.h> | ||||
| +#include <linux/phylink.h> | ||||
|   | ||||
|  #define AT803X_SPECIFIC_STATUS			0x11 | ||||
|  #define AT803X_SS_SPEED_MASK			(3 << 14) | ||||
| @@ -53,9 +55,18 @@ | ||||
|   | ||||
|  #define AT803X_MODE_CFG_MASK			0x0F | ||||
|  #define AT803X_MODE_CFG_SGMII			0x01 | ||||
| +#define AT803X_MODE_CFG_BX1000_RGMII_50		0x02 | ||||
| +#define AT803X_MODE_CFG_BX1000_RGMII_75		0x03 | ||||
| +#define AT803X_MODE_FIBER			0x01 | ||||
| +#define AT803X_MODE_COPPER			0x00 | ||||
|   | ||||
|  #define AT803X_PSSR			0x11	/*PHY-Specific Status Register*/ | ||||
|  #define AT803X_PSSR_MR_AN_COMPLETE	0x0200 | ||||
| +#define	 PSSR_LINK			BIT(10) | ||||
| +#define	 PSSR_SYNC_STATUS		BIT(8) | ||||
| +#define	 PSSR_DUPLEX			BIT(13) | ||||
| +#define	 PSSR_SPEED_1000		BIT(15) | ||||
| +#define	 PSSR_SPEED_100			BIT(14) | ||||
|   | ||||
|  #define AT803X_DEBUG_REG_0			0x00 | ||||
|  #define AT803X_DEBUG_RX_CLK_DLY_EN		BIT(15) | ||||
| @@ -243,10 +254,72 @@ static int at803x_resume(struct phy_devi | ||||
|  	return phy_modify(phydev, MII_BMCR, BMCR_PDOWN | BMCR_ISOLATE, 0); | ||||
|  } | ||||
|   | ||||
| +static int at803x_mode(struct phy_device *phydev) | ||||
| +{ | ||||
| +	int mode; | ||||
| + | ||||
| +	mode = phy_read(phydev, AT803X_REG_CHIP_CONFIG) & AT803X_MODE_CFG_MASK; | ||||
| + | ||||
| +	if (mode == AT803X_MODE_CFG_BX1000_RGMII_50 || | ||||
| +	    mode == AT803X_MODE_CFG_BX1000_RGMII_75) | ||||
| +		return AT803X_MODE_FIBER; | ||||
| +	return AT803X_MODE_COPPER; | ||||
| +} | ||||
| + | ||||
| +static int at803x_sfp_insert(void *upstream, const struct sfp_eeprom_id *id) | ||||
| +{ | ||||
| +	__ETHTOOL_DECLARE_LINK_MODE_MASK(at803x_support) = { 0, }; | ||||
| +	__ETHTOOL_DECLARE_LINK_MODE_MASK(support) = { 0, }; | ||||
| +	struct phy_device *phydev = upstream; | ||||
| +	phy_interface_t iface; | ||||
| + | ||||
| +	phylink_set(at803x_support, 1000baseX_Full); | ||||
| +	/* AT803x only support 1000baseX but SGMII works fine when module runs | ||||
| +	 * at 1Gbit. | ||||
| +	 */ | ||||
| +	phylink_set(at803x_support, 1000baseT_Full); | ||||
| + | ||||
| +	sfp_parse_support(phydev->sfp_bus, id, support); | ||||
| + | ||||
| +	// Limit to interfaces that both sides support | ||||
| +	linkmode_and(support, support, at803x_support); | ||||
| + | ||||
| +	if (linkmode_empty(support)) | ||||
| +		goto unsupported_mode; | ||||
| + | ||||
| +	iface = sfp_select_interface(phydev->sfp_bus, support); | ||||
| + | ||||
| +	if (iface != PHY_INTERFACE_MODE_SGMII && | ||||
| +	    iface != PHY_INTERFACE_MODE_1000BASEX) | ||||
| +		goto unsupported_mode; | ||||
| + | ||||
| +	dev_info(&phydev->mdio.dev, "SFP interface %s", phy_modes(iface)); | ||||
| + | ||||
| +	return 0; | ||||
| + | ||||
| +unsupported_mode: | ||||
| +	dev_info(&phydev->mdio.dev, "incompatible SFP module inserted;" | ||||
| +		 "Only SGMII at 1Gbit/1000BASEX are supported!\n"); | ||||
| +	return -EINVAL; | ||||
| +} | ||||
| + | ||||
| +static const struct sfp_upstream_ops at803x_sfp_ops = { | ||||
| +	.attach = phy_sfp_attach, | ||||
| +	.detach = phy_sfp_detach, | ||||
| +	.module_insert = at803x_sfp_insert, | ||||
| +}; | ||||
| + | ||||
|  static int at803x_probe(struct phy_device *phydev) | ||||
|  { | ||||
|  	struct device *dev = &phydev->mdio.dev; | ||||
|  	struct at803x_priv *priv; | ||||
| +	int ret; | ||||
| + | ||||
| +	if (at803x_mode(phydev) == AT803X_MODE_FIBER) { | ||||
| +		ret = phy_sfp_probe(phydev, &at803x_sfp_ops); | ||||
| +		if (ret < 0) | ||||
| +			return ret; | ||||
| +	} | ||||
|   | ||||
|  	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); | ||||
|  	if (!priv) | ||||
| @@ -394,6 +467,10 @@ static int at803x_read_status(struct phy | ||||
|  { | ||||
|  	int ss, err, old_link = phydev->link; | ||||
|   | ||||
| +	/* Handle (Fiber) SGMII to RGMII mode */ | ||||
| +	if (at803x_mode(phydev) == AT803X_MODE_FIBER) | ||||
| +		return genphy_c37_read_status(phydev); | ||||
| + | ||||
|  	/* Update the link, but return if there was an error */ | ||||
|  	err = genphy_update_link(phydev); | ||||
|  	if (err) | ||||
| @@ -448,6 +525,19 @@ static int at803x_read_status(struct phy | ||||
|  	return 0; | ||||
|  } | ||||
|   | ||||
| +static int at803x_config_aneg(struct phy_device *phydev) | ||||
| +{ | ||||
| +	/* Handle (Fiber) SerDes to RGMII mode */ | ||||
| +	if (at803x_mode(phydev) == AT803X_MODE_FIBER) { | ||||
| +		pr_warn("%s: fiber\n", __func__); | ||||
| +		return genphy_c37_config_aneg(phydev); | ||||
| +	} | ||||
| + | ||||
| +	pr_warn("%s: enter\n", __func__); | ||||
| + | ||||
| +	return genphy_config_aneg(phydev); | ||||
| +} | ||||
| + | ||||
|  static struct phy_driver at803x_driver[] = { | ||||
|  { | ||||
|  	/* ATHEROS 8035 */ | ||||
| @@ -491,6 +581,7 @@ static struct phy_driver at803x_driver[] | ||||
|  	.suspend		= at803x_suspend, | ||||
|  	.resume			= at803x_resume, | ||||
|  	/* PHY_GBIT_FEATURES */ | ||||
| +	.config_aneg		= at803x_config_aneg, | ||||
|  	.read_status		= at803x_read_status, | ||||
|  	.aneg_done		= at803x_aneg_done, | ||||
|  	.ack_interrupt		= &at803x_ack_interrupt, | ||||
| @@ -0,0 +1,21 @@ | ||||
| --- a/arch/mips/pci/pci-mt7620.c | ||||
| +++ b/arch/mips/pci/pci-mt7620.c | ||||
| @@ -32,6 +32,7 @@ | ||||
|  #define PPLL_CFG1			0x9c | ||||
|   | ||||
|  #define PPLL_DRV			0xa0 | ||||
| +#define PPLL_LD			BIT(23) | ||||
|  #define PDRV_SW_SET			BIT(31) | ||||
|  #define LC_CKDRVPD			BIT(19) | ||||
|  #define LC_CKDRVOHZ			BIT(18) | ||||
| @@ -239,8 +240,8 @@ static int mt7620_pci_hw_init(struct pla | ||||
|  	rt_sysc_m32(0, RALINK_PCIE0_CLK_EN, RALINK_CLKCFG1); | ||||
|  	mdelay(100); | ||||
|   | ||||
| -	if (!(rt_sysc_r32(PPLL_CFG1) & PDRV_SW_SET)) { | ||||
| -		dev_err(&pdev->dev, "MT7620 PPLL unlock\n"); | ||||
| +	if (!(rt_sysc_r32(PPLL_CFG1) & PPLL_LD)) { | ||||
| +		dev_err(&pdev->dev, "MT7620 PPLL is unlocked, aborting init\n"); | ||||
|  		reset_control_assert(rstpcie0); | ||||
|  		rt_sysc_m32(RALINK_PCIE0_CLK_EN, 0, RALINK_CLKCFG1); | ||||
|  		return -1; | ||||
		Reference in New Issue
	
	Block a user