On Tue, May 24, 2022 at 09:04:11AM +0300, Alexander Shiyan wrote:
> This is a complex patch that switches the ARM CLPS711X architecture
> to work with the device tree. Includes changes to board initialization
> and any architecture drivers used.
> 
> Signed-off-by: Alexander Shiyan <[email protected]>
> ---

Applied, thanks

Sascha

>  arch/arm/Kconfig                              |   4 +
>  arch/arm/boards/clep7212/Makefile             |   4 +-
>  arch/arm/boards/clep7212/board.c              |  15 ++
>  arch/arm/boards/clep7212/clep7212.c           |  57 -------
>  arch/arm/boards/clep7212/lowlevel.c           |  23 ++-
>  arch/arm/configs/clps711x_defconfig           |   5 +-
>  arch/arm/dts/Makefile                         |   1 +
>  arch/arm/dts/ep7212-clep7212.dts              |  64 ++++++++
>  arch/arm/mach-clps711x/Kconfig                |   9 --
>  arch/arm/mach-clps711x/Makefile               |   2 +-
>  arch/arm/mach-clps711x/clock.c                |  46 +++---
>  arch/arm/mach-clps711x/common.c               | 149 ++++++++++++++++++
>  .../arm/mach-clps711x/include/mach/clps711x.h |  28 ++--
>  .../arm/mach-clps711x/include/mach/debug_ll.h |  21 +++
>  arch/arm/mach-clps711x/include/mach/devices.h |   9 --
>  arch/arm/mach-clps711x/lowlevel.c             |  72 +++++----
>  arch/arm/mach-clps711x/reset.c                |  29 ----
>  drivers/clocksource/clps711x.c                |   7 +-
>  drivers/gpio/gpio-clps711x.c                  |   7 +-
>  drivers/serial/serial_clps711x.c              |  57 ++++---
>  images/Makefile                               |   1 +
>  images/Makefile.clps711x                      |   8 +
>  22 files changed, 395 insertions(+), 223 deletions(-)
>  create mode 100644 arch/arm/boards/clep7212/board.c
>  delete mode 100644 arch/arm/boards/clep7212/clep7212.c
>  create mode 100644 arch/arm/dts/ep7212-clep7212.dts
>  create mode 100644 arch/arm/mach-clps711x/common.c
>  create mode 100644 arch/arm/mach-clps711x/include/mach/debug_ll.h
>  delete mode 100644 arch/arm/mach-clps711x/include/mach/devices.h
>  delete mode 100644 arch/arm/mach-clps711x/reset.c
>  create mode 100644 images/Makefile.clps711x
> 
> diff --git a/arch/arm/Kconfig b/arch/arm/Kconfig
> index 299e0ab080..8a1d75c19b 100644
> --- a/arch/arm/Kconfig
> +++ b/arch/arm/Kconfig
> @@ -66,9 +66,13 @@ config ARCH_CLPS711X
>       select CLKDEV_LOOKUP
>       select CLOCKSOURCE_CLPS711X
>       select COMMON_CLK
> +     select COMMON_CLK_OF_PROVIDER
>       select CPU_32v4T
>       select GPIOLIB
> +     select HAS_DEBUG_LL
> +     select HAVE_PBL_MULTI_IMAGES
>       select MFD_SYSCON
> +     select RELOCATABLE
>  
>  config ARCH_DAVINCI
>       bool "TI Davinci"
> diff --git a/arch/arm/boards/clep7212/Makefile 
> b/arch/arm/boards/clep7212/Makefile
> index 096120e567..85d92c8a7f 100644
> --- a/arch/arm/boards/clep7212/Makefile
> +++ b/arch/arm/boards/clep7212/Makefile
> @@ -1,5 +1,5 @@
>  # SPDX-License-Identifier: GPL-2.0-only
>  
> -obj-y += clep7212.o
> +obj-y += board.o
>  lwl-y += lowlevel.o
> -bbenv-y += defaultenv-clep7212
> +bbenv-$(CONFIG_DEFAULT_ENVIRONMENT) += defaultenv-clep7212
> diff --git a/arch/arm/boards/clep7212/board.c 
> b/arch/arm/boards/clep7212/board.c
> new file mode 100644
> index 0000000000..b3983f2f49
> --- /dev/null
> +++ b/arch/arm/boards/clep7212/board.c
> @@ -0,0 +1,15 @@
> +// SPDX-License-Identifier: GPL-2.0-or-later
> +// SPDX-FileCopyrightText: Alexander Shiyan <[email protected]>
> +
> +#include <envfs.h>
> +#include <init.h>
> +#include <of.h>
> +
> +static __init int clep7212_init(void)
> +{
> +     if (of_machine_is_compatible("cirrus,clep7212"))
> +             defaultenv_append_directory(defaultenv_clep7212);
> +
> +     return 0;
> +}
> +device_initcall(clep7212_init);
> diff --git a/arch/arm/boards/clep7212/clep7212.c 
> b/arch/arm/boards/clep7212/clep7212.c
> deleted file mode 100644
> index 3b497a6bd2..0000000000
> --- a/arch/arm/boards/clep7212/clep7212.c
> +++ /dev/null
> @@ -1,57 +0,0 @@
> -// SPDX-License-Identifier: GPL-2.0-or-later
> -// SPDX-FileCopyrightText: 2012 Alexander Shiyan <[email protected]>
> -
> -#include <common.h>
> -#include <driver.h>
> -#include <envfs.h>
> -#include <init.h>
> -#include <partition.h>
> -#include <io.h>
> -#include <linux/sizes.h>
> -#include <asm/armlinux.h>
> -#include <asm/mmu.h>
> -#include <generated/mach-types.h>
> -
> -#include <mach/clps711x.h>
> -#include <mach/devices.h>
> -
> -static int clps711x_devices_init(void)
> -{
> -     u32 serial_h = 0, serial_l = readl(UNIQID);
> -     void *cfi_io;
> -
> -     /* Setup Chipselects */
> -     clps711x_setup_memcfg(0, MEMCFG_WAITSTATE_6_1 | MEMCFG_BUS_WIDTH_16);
> -     clps711x_setup_memcfg(1, MEMCFG_WAITSTATE_6_1 | MEMCFG_BUS_WIDTH_8);
> -     clps711x_setup_memcfg(2, MEMCFG_WAITSTATE_8_3 | MEMCFG_BUS_WIDTH_16 |
> -                           MEMCFG_CLKENB);
> -     clps711x_setup_memcfg(3, MEMCFG_WAITSTATE_7_1 | MEMCFG_BUS_WIDTH_32);
> -
> -     cfi_io = map_io_sections(CS0_BASE, (void *)0x90000000, SZ_32M);
> -     add_cfi_flash_device(DEVICE_ID_DYNAMIC, (unsigned long)cfi_io, SZ_32M,
> -                          IORESOURCE_MEM);
> -
> -     devfs_add_partition("nor0", 0x00000, SZ_512K, DEVFS_PARTITION_FIXED,
> -                         "self0");
> -     devfs_add_partition("nor0", SZ_256K, SZ_256K, DEVFS_PARTITION_FIXED,
> -                         "env0");
> -
> -     armlinux_set_architecture(MACH_TYPE_CLEP7212);
> -     armlinux_set_serial(((u64)serial_h << 32) | serial_l);
> -
> -     defaultenv_append_directory(defaultenv_clep7212);
> -
> -     return 0;
> -}
> -device_initcall(clps711x_devices_init);
> -
> -static int clps711x_console_init(void)
> -{
> -     barebox_set_model("Cirrus Logic CLEP7212");
> -     barebox_set_hostname("clep7212");
> -
> -     clps711x_add_uart(0);
> -
> -     return 0;
> -}
> -console_initcall(clps711x_console_init);
> diff --git a/arch/arm/boards/clep7212/lowlevel.c 
> b/arch/arm/boards/clep7212/lowlevel.c
> index 41827dfa16..09f2762fac 100644
> --- a/arch/arm/boards/clep7212/lowlevel.c
> +++ b/arch/arm/boards/clep7212/lowlevel.c
> @@ -1,22 +1,21 @@
>  // SPDX-License-Identifier: GPL-2.0-or-later
> -// SPDX-FileCopyrightText: 2012 Alexander Shiyan <[email protected]>
> +// SPDX-FileCopyrightText: Alexander Shiyan <[email protected]>
>  
>  #include <common.h>
> -#include <init.h>
> -
> -#include <asm/barebox-arm-head.h>
> -
> +#include <asm/barebox-arm.h>
> +#include <linux/sizes.h>
>  #include <mach/clps711x.h>
>  
> -#ifdef CONFIG_CLPS711X_RAISE_CPUFREQ
> -# define CLPS711X_CPU_PLL_MULT       50
> -#else
> -# define CLPS711X_CPU_PLL_MULT       40
> -#endif
> +extern char __dtb_ep7212_clep7212_start[];
>  
> -void __naked __bare_init barebox_arm_reset_vector(uint32_t r0, uint32_t r1, 
> uint32_t r2)
> +ENTRY_FUNCTION_WITHSTACK(start_ep7212_clep7212,
> +                      CS6_BASE + 48 * SZ_1K, r0, r1, r2)
>  {
> +     void *fdt;
> +
>       arm_cpu_lowlevel_init();
>  
> -     clps711x_barebox_entry(CLPS711X_CPU_PLL_MULT, NULL);
> +     fdt = __dtb_ep7212_clep7212_start;
> +
> +     clps711x_start(fdt + get_runtime_offset());
>  }
> diff --git a/arch/arm/configs/clps711x_defconfig 
> b/arch/arm/configs/clps711x_defconfig
> index d9eab565b9..684ae79e22 100644
> --- a/arch/arm/configs/clps711x_defconfig
> +++ b/arch/arm/configs/clps711x_defconfig
> @@ -1,8 +1,8 @@
>  CONFIG_ARCH_CLPS711X=y
> +CONFIG_CLPS711X_RAISE_CPUFREQ=y
>  CONFIG_AEABI=y
>  CONFIG_ARM_OPTIMZED_STRING_FUNCTIONS=y
>  # CONFIG_MEMINFO is not set
> -CONFIG_PBL_IMAGE=y
>  CONFIG_MMU=y
>  CONFIG_EXPERIMENTAL=y
>  CONFIG_BAUDRATE=57600
> @@ -28,6 +28,8 @@ CONFIG_CMD_TIMEOUT=y
>  CONFIG_CMD_CRC=y
>  CONFIG_CMD_CRC_CMP=y
>  CONFIG_CMD_FLASH=y
> +CONFIG_OFDEVICE=y
> +CONFIG_OF_BAREBOX_DRIVERS=y
>  # CONFIG_SPI is not set
>  CONFIG_MTD=y
>  CONFIG_DRIVER_CFI=y
> @@ -36,6 +38,7 @@ CONFIG_DRIVER_CFI=y
>  CONFIG_DISK=y
>  CONFIG_DISK_WRITE=y
>  CONFIG_DISK_INTF_PLATFORM_IDE=y
> +# CONFIG_PINCTRL is not set
>  CONFIG_FS_CRAMFS=y
>  CONFIG_FS_FAT=y
>  CONFIG_FS_FAT_LFN=y
> diff --git a/arch/arm/dts/Makefile b/arch/arm/dts/Makefile
> index 46e5e67672..d67d10bde8 100644
> --- a/arch/arm/dts/Makefile
> +++ b/arch/arm/dts/Makefile
> @@ -8,6 +8,7 @@ lwl-$(CONFIG_MACH_ADVANTECH_ROM_742X) += 
> imx6dl-advantech-rom-7421.dtb.o
>  lwl-$(CONFIG_MACH_AFI_GF) += am335x-afi-gf.dtb.o
>  lwl-$(CONFIG_MACH_BEAGLEBONE) += am335x-bone.dtb.o am335x-boneblack.dtb.o 
> am335x-bone-common.dtb.o
>  lwl-$(CONFIG_MACH_CANON_A1100) += canon-a1100.dtb.o
> +lwl-$(CONFIG_MACH_CLEP7212) += ep7212-clep7212.dtb.o
>  lwl-$(CONFIG_MACH_CM_FX6) += imx6dl-cm-fx6.dtb.o imx6q-cm-fx6.dtb.o 
> imx6q-utilite.dtb.o
>  lwl-$(CONFIG_MACH_DFI_FS700_M60) += imx6q-dfi-fs700-m60-6q.dtb.o 
> imx6dl-dfi-fs700-m60-6s.dtb.o
>  lwl-$(CONFIG_MACH_DUCKBILL) += imx28-duckbill.dtb.o
> diff --git a/arch/arm/dts/ep7212-clep7212.dts 
> b/arch/arm/dts/ep7212-clep7212.dts
> new file mode 100644
> index 0000000000..84c5e79548
> --- /dev/null
> +++ b/arch/arm/dts/ep7212-clep7212.dts
> @@ -0,0 +1,64 @@
> +// SPDX-License-Identifier: GPL-2.0+
> +/* Author: Alexander Shiyan <[email protected]> */
> +
> +#include <arm/ep7211.dtsi>
> +
> +/ {
> +     model = "Cirrus Logic EP7212";
> +     compatible = "cirrus,clep7212", "cirrus,ep7212", "cirrus,ep7209";
> +
> +     memory@c0000000 {
> +             device_type = "memory";
> +             reg = <0xc0000000 0x02000000>;
> +     };
> +
> +     chosen {
> +             stdout-path = &uart1;
> +
> +             environment {
> +                     compatible = "barebox,environment";
> +                     device-path = &flash, "partname:env";
> +             };
> +     };
> +};
> +
> +&bus {
> +     /* Setup Memory Timings */
> +     /* CS0 = WAITSTATE_6_1 | BUS_WIDTH_16 */
> +     /* CS1 = WAITSTATE_6_1 | BUS_WIDTH_8 */
> +     /* CS2 = WAITSTATE_8_3 | BUS_WIDTH_16 | CLKENB */
> +     /* CS3 = WAITSTATE_7_1 | BUS_WIDTH_32 */
> +     barebox,ep7209-memcfg1 = <0x25802b28>;
> +
> +     flash: nor@0,0 {
> +             compatible = "cfi-flash";
> +             reg = <0 0x00000000 0x02000000>;
> +             bank-width = <2>;
> +
> +             partitions {
> +                     compatible = "fixed-partitions";
> +                     #address-cells = <1>;
> +                     #size-cells = <1>;
> +
> +                     partition@0 {
> +                             label = "boot";
> +                             reg = <0x00000 0x80000>;
> +                     };
> +
> +                     partition@80000 {
> +                             label = "env";
> +                             reg = <0x80000 0x40000>;
> +                     };
> +
> +                     partition@c0000 {
> +                             label = "kernel";
> +                             reg = <0xc0000 0x340000>;
> +                     };
> +
> +                     partition@400000 {
> +                             label = "root";
> +                             reg = <0x400000 0>;
> +                     };
> +             };
> +     };
> +};
> diff --git a/arch/arm/mach-clps711x/Kconfig b/arch/arm/mach-clps711x/Kconfig
> index 52cf8468c0..6cf6bc37a2 100644
> --- a/arch/arm/mach-clps711x/Kconfig
> +++ b/arch/arm/mach-clps711x/Kconfig
> @@ -16,7 +16,6 @@ menu "CLPS711X specific settings"
>  
>  config CLPS711X_RAISE_CPUFREQ
>       bool "Raise CPU frequency to 90 MHz"
> -     depends on MACH_CLEP7212
>       help
>         Raise CPU frequency to 90 MHz. This operation can be performed
>         only for devices which allow to operate at 90 MHz.
> @@ -24,12 +23,4 @@ config CLPS711X_RAISE_CPUFREQ
>  
>  endmenu
>  
> -config ARCH_TEXT_BASE
> -     hex
> -     default 0xc0740000 if MACH_CLEP7212
> -
> -config BAREBOX_MAX_IMAGE_SIZE
> -     hex
> -     default 0x00080000 if MACH_CLEP7212
> -
>  endif
> diff --git a/arch/arm/mach-clps711x/Makefile b/arch/arm/mach-clps711x/Makefile
> index 4d5950d9b5..871c5f7e9c 100644
> --- a/arch/arm/mach-clps711x/Makefile
> +++ b/arch/arm/mach-clps711x/Makefile
> @@ -1,4 +1,4 @@
>  # SPDX-License-Identifier: GPL-2.0-only
>  
> -obj-y += clock.o devices.o reset.o
> +obj-y += clock.o common.o
>  lwl-y += lowlevel.o
> diff --git a/arch/arm/mach-clps711x/clock.c b/arch/arm/mach-clps711x/clock.c
> index 2c5137c582..8674b8c801 100644
> --- a/arch/arm/mach-clps711x/clock.c
> +++ b/arch/arm/mach-clps711x/clock.c
> @@ -1,11 +1,5 @@
> -/*
> - * Copyright (C) 2012-2016 Alexander Shiyan <[email protected]>
> - *
> - * This program is free software; you can redistribute it and/or
> - * modify it under the terms of the GNU General Public License as
> - * published by the Free Software Foundation; either version 2 of
> - * the License, or (at your option) any later version.
> - */
> +// SPDX-License-Identifier: GPL-2.0-or-later
> +// SPDX-FileCopyrightText: Alexander Shiyan <[email protected]>
>  
>  #include <common.h>
>  #include <init.h>
> @@ -21,13 +15,15 @@
>  #define CLPS711X_EXT_FREQ    13000000
>  
>  static struct clk *clks[CLPS711X_CLK_MAX];
> +static struct clk_onecell_data clk_data;
>  
> -static struct clk_div_table tdiv_tbl[] = {
> +static const struct clk_div_table tdiv_tbl[] = {
>       { .val = 0, .div = 256, },
>       { .val = 1, .div = 1, },
> +     { }
>  };
>  
> -static __init int clps711x_clk_init(void)
> +static int clps711x_clk_probe(struct device_d *dev)
>  {
>       unsigned int f_cpu, f_bus, f_uart, f_timer_ref, pll;
>       u32 tmp;
> @@ -50,7 +46,7 @@ static __init int clps711x_clk_init(void)
>                       f_bus = 36864000 / 2;
>       }
>  
> -     f_uart = f_bus / 10;
> +     f_uart = DIV_ROUND_CLOSEST(f_bus, 10);
>  
>       if (tmp & SYSFLG2_CKMODE) {
>               tmp = readw(SYSCON2);
> @@ -72,23 +68,25 @@ static __init int clps711x_clk_init(void)
>       clks[CLPS711X_CLK_UART] = clk_fixed("uart", f_uart);
>       clks[CLPS711X_CLK_TIMERREF] = clk_fixed("timer_ref", f_timer_ref);
>       clks[CLPS711X_CLK_TIMER1] = clk_divider_table("timer1", "timer_ref", 0,
> -             IOMEM(SYSCON1), 5, 1, tdiv_tbl, ARRAY_SIZE(tdiv_tbl));
> +             IOMEM(SYSCON1), 5, 1, tdiv_tbl, 0);
>       clks[CLPS711X_CLK_TIMER2] = clk_divider_table("timer2", "timer_ref", 0,
> -             IOMEM(SYSCON1), 7, 1, tdiv_tbl, ARRAY_SIZE(tdiv_tbl));
> +             IOMEM(SYSCON1), 7, 1, tdiv_tbl, 0);
>  
> -     clkdev_add_physbase(clks[CLPS711X_CLK_UART], UARTDR1, NULL);
> -     clkdev_add_physbase(clks[CLPS711X_CLK_UART], UARTDR2, NULL);
> -     clkdev_add_physbase(clks[CLPS711X_CLK_TIMER2], TC2D, NULL);
> +     clk_data.clks = clks;
> +     clk_data.clk_num = CLPS711X_CLK_MAX;
> +     of_clk_add_provider(dev->device_node, of_clk_src_onecell_get, 
> &clk_data);
>  
>       return 0;
>  }
> -postcore_initcall(clps711x_clk_init);
>  
> -static __init int clps711x_core_init(void)
> -{
> -     add_generic_device("clps711x-cs", DEVICE_ID_SINGLE, NULL,
> -                        TC2D, SZ_2, IORESOURCE_MEM, NULL);
> +static const struct of_device_id __maybe_unused clps711x_clk_dt_ids[] = {
> +     { .compatible = "cirrus,ep7209-clk", },
> +     { }
> +};
>  
> -     return 0;
> -}
> -coredevice_initcall(clps711x_core_init);
> +static struct driver_d clps711x_clk_driver = {
> +     .probe = clps711x_clk_probe,
> +     .name = "clps711x-clk",
> +     .of_compatible = DRV_OF_COMPAT(clps711x_clk_dt_ids),
> +};
> +postcore_platform_driver(clps711x_clk_driver);
> diff --git a/arch/arm/mach-clps711x/common.c b/arch/arm/mach-clps711x/common.c
> new file mode 100644
> index 0000000000..c0b817872d
> --- /dev/null
> +++ b/arch/arm/mach-clps711x/common.c
> @@ -0,0 +1,149 @@
> +// SPDX-License-Identifier: GPL-2.0-or-later
> +// SPDX-FileCopyrightText: Alexander Shiyan <[email protected]>
> +
> +#include <common.h>
> +#include <driver.h>
> +#include <restart.h>
> +#include <asm/io.h>
> +#include <asm/mmu.h>
> +#include <mach/clps711x.h>
> +
> +#define CLPS711X_MAP_ADDR    0x90000000
> +
> +static u32 remap_size = 0;
> +
> +static void __noreturn clps711x_restart(struct restart_handler *rst)
> +{
> +     shutdown_barebox();
> +
> +     asm("mov pc, #0");
> +
> +     hang();
> +}
> +
> +static __init int is_clps711x_compatible(void)
> +{
> +     return of_machine_is_compatible("cirrus,ep7209");
> +}
> +
> +static __init int clps711x_init(void)
> +{
> +     char *serial;
> +
> +     if (!is_clps711x_compatible())
> +             return 0;
> +
> +     restart_handler_register_fn("vector", clps711x_restart);
> +
> +     serial = basprintf("%08x%08x", 0, readl(UNIQID));
> +
> +     barebox_set_serial_number(serial);
> +
> +     free(serial);
> +
> +     return 0;
> +}
> +postcore_initcall(clps711x_init);
> +
> +static int __init clps711x_bus_map(void)
> +{
> +     if (is_clps711x_compatible() && remap_size)
> +             map_io_sections(0, (void *)CLPS711X_MAP_ADDR, remap_size);
> +
> +     return 0;
> +}
> +postmmu_initcall(clps711x_bus_map);
> +
> +/* Scan for devices that start at zero address and maps them
> + * to a different unused address.
> + * To start the kernel, a fixup is used that rewrites the address
> + * of the patched device to its original state.
> + */
> +
> +static void clps711x_bus_patch(struct device_node *node,
> +                            u32 compare, u32 change)
> +{
> +     const __be32 *ranges;
> +     int rsize;
> +
> +     ranges = of_get_property(node, "ranges", &rsize);
> +
> +     if (ranges) {
> +             int banks = rsize / (sizeof(u32) * 4);
> +             __be32 *fixed, *fixedptr;
> +
> +             fixed = xmalloc(rsize);
> +             fixedptr = fixed;
> +
> +             while (banks--) {
> +                     u32 bank, cell, addr, size;
> +
> +                     bank = be32_to_cpu(*ranges++);
> +                     cell = be32_to_cpu(*ranges++);
> +                     addr = be32_to_cpu(*ranges++);
> +                     size = be32_to_cpu(*ranges++);
> +
> +                     if (addr == compare) {
> +                             addr = change;
> +                             remap_size = size;
> +                     }
> +
> +                     *fixedptr++ = cpu_to_be32(bank);
> +                     *fixedptr++ = cpu_to_be32(cell);
> +                     *fixedptr++ = cpu_to_be32(addr);
> +                     *fixedptr++ = cpu_to_be32(size);
> +             }
> +
> +             of_set_property(node, "ranges", fixed, rsize, 0);
> +
> +             free(fixed);
> +     }
> +}
> +
> +static int clps711x_bus_fixup(struct device_node *root, void *context)
> +{
> +     struct device_node *node = context;
> +
> +     if (remap_size)
> +             clps711x_bus_patch(node, CLPS711X_MAP_ADDR, 0);
> +
> +     return 0;
> +}
> +
> +static int clps711x_bus_probe(struct device_d *dev)
> +{
> +     u32 mcfg;
> +
> +     /* Setup bus timings */
> +     if (!of_property_read_u32(dev->device_node,
> +                               "barebox,ep7209-memcfg1", &mcfg))
> +             writel(mcfg, MEMCFG1);
> +     if (!of_property_read_u32(dev->device_node,
> +                               "barebox,ep7209-memcfg2", &mcfg))
> +             writel(mcfg, MEMCFG2);
> +
> +     clps711x_bus_patch(dev->device_node, 0, CLPS711X_MAP_ADDR);
> +
> +     of_platform_populate(dev->device_node, NULL, dev);
> +
> +     of_register_fixup(clps711x_bus_fixup, dev->device_node);
> +
> +     return 0;
> +}
> +
> +static const struct of_device_id __maybe_unused clps711x_bus_dt_ids[] = {
> +     { .compatible = "cirrus,ep7209-bus", },
> +     { }
> +};
> +
> +static struct driver_d clps711x_bus_driver = {
> +     .name = "clps711x-bus",
> +     .probe = clps711x_bus_probe,
> +     .of_compatible = DRV_OF_COMPAT(clps711x_bus_dt_ids),
> +};
> +
> +static int __init clps711x_bus_init(void)
> +{
> +     return platform_driver_register(&clps711x_bus_driver);
> +}
> +core_initcall(clps711x_bus_init);
> diff --git a/arch/arm/mach-clps711x/include/mach/clps711x.h 
> b/arch/arm/mach-clps711x/include/mach/clps711x.h
> index 957b2b8477..9aef7f3fd3 100644
> --- a/arch/arm/mach-clps711x/include/mach/clps711x.h
> +++ b/arch/arm/mach-clps711x/include/mach/clps711x.h
> @@ -1,13 +1,7 @@
> +/* SPDX-License-Identifier: GPL-2.0+ */
>  /*
> - *  Hardware definitions for Cirrus Logic CLPS711X
> - *
> - *  Copyright (C) 2000 Deep Blue Solutions Ltd.
> - *  Copyright (C) 2012 Alexander Shiyan <[email protected]>
> - *
> - * This program is free software; you can redistribute it and/or modify
> - * it under the terms of the GNU General Public License as published by
> - * the Free Software Foundation; either version 2 of the License, or
> - * (at your option) any later version.
> + * Copyright (C) 2000 Deep Blue Solutions Ltd.
> + * Copyright (C) 2012-2022 Alexander Shiyan <[email protected]>
>   */
>  
>  #ifndef __MACH_CLPS711X_H
> @@ -159,6 +153,10 @@
>  #define SYSCON2_CLKENSL              (1 << 13)
>  #define SYSCON2_BUZFREQ              (1 << 14)
>  
> +#define SYSCON_UARTEN                (1 << 8)
> +#define SYSFLG_UBUSY         (1 << 11)
> +#define SYSFLG_UTXFF         (1 << 23)
> +
>  #define SYNCIO_FRMLEN(x)     (((x) & 0x1f) << 8)
>  #define SYNCIO_SMCKEN                (1 << 13)
>  #define SYNCIO_TXFRMEN               (1 << 14)
> @@ -247,6 +245,16 @@
>  #define MEMCFG_WAITSTATE_2_0 (14 << 2)
>  #define MEMCFG_WAITSTATE_1_0 (15 << 2)
>  
> -void clps711x_barebox_entry(u32, void *);
> +#define UBRLCR_BREAK         (1 << 12)
> +#define UBRLCR_PRTEN         (1 << 13)
> +#define UBRLCR_EVENPRT               (1 << 14)
> +#define UBRLCR_XSTOP         (1 << 15)
> +#define UBRLCR_FIFOEN                (1 << 16)
> +#define UBRLCR_WRDLEN5               (0 << 17)
> +#define UBRLCR_WRDLEN6               (1 << 17)
> +#define UBRLCR_WRDLEN7               (2 << 17)
> +#define UBRLCR_WRDLEN8               (3 << 17)
> +
> +void clps711x_start(void *);
>  
>  #endif
> diff --git a/arch/arm/mach-clps711x/include/mach/debug_ll.h 
> b/arch/arm/mach-clps711x/include/mach/debug_ll.h
> new file mode 100644
> index 0000000000..342bb7628a
> --- /dev/null
> +++ b/arch/arm/mach-clps711x/include/mach/debug_ll.h
> @@ -0,0 +1,21 @@
> +// SPDX-License-Identifier: GPL-2.0-or-later
> +// SPDX-FileCopyrightText: Alexander Shiyan <[email protected]>
> +
> +#ifndef __MACH_DEBUG_LL_H__
> +#define __MACH_DEBUG_LL_H__
> +
> +#include <asm/io.h>
> +#include <mach/clps711x.h>
> +
> +static inline void PUTC_LL(char c)
> +{
> +     do {
> +     } while (readl(SYSFLG1) & SYSFLG_UTXFF);
> +
> +     writew(c, UARTDR1);
> +
> +     do {
> +     } while (readl(SYSFLG1) & SYSFLG_UBUSY);
> +}
> +
> +#endif
> diff --git a/arch/arm/mach-clps711x/include/mach/devices.h 
> b/arch/arm/mach-clps711x/include/mach/devices.h
> deleted file mode 100644
> index 77c43be25c..0000000000
> --- a/arch/arm/mach-clps711x/include/mach/devices.h
> +++ /dev/null
> @@ -1,9 +0,0 @@
> -/* SPDX-License-Identifier: GPL-2.0-only */
> -
> -#ifndef __MACH_DEVICES_H
> -#define __MACH_DEVICES_H
> -
> -void clps711x_setup_memcfg(int bank, u32 val);
> -void clps711x_add_uart(unsigned int id);
> -
> -#endif
> diff --git a/arch/arm/mach-clps711x/lowlevel.c 
> b/arch/arm/mach-clps711x/lowlevel.c
> index 35b8b35e87..608f0778d7 100644
> --- a/arch/arm/mach-clps711x/lowlevel.c
> +++ b/arch/arm/mach-clps711x/lowlevel.c
> @@ -1,25 +1,31 @@
> -/*
> - * Copyright (C) 2012 Alexander Shiyan <[email protected]>
> - *
> - * This program is free software; you can redistribute it and/or
> - * modify it under the terms of the GNU General Public License as
> - * published by the Free Software Foundation; either version 2 of
> - * the License, or (at your option) any later version.
> - */
> +// SPDX-License-Identifier: GPL-2.0-or-later
> +// SPDX-FileCopyrightText: Alexander Shiyan <[email protected]>
>  
> +#include <asm/io.h>
> +#include <asm/barebox-arm.h>
>  #include <common.h>
> -#include <init.h>
> +#include <debug_ll.h>
>  #include <linux/sizes.h>
> +#include <mach/clps711x.h>
>  
> -#include <asm/io.h>
> -#include <asm/barebox-arm.h>
> -#include <asm/barebox-arm-head.h>
> +#define DEBUG_LL_BAUDRATE    (57600)
>  
> -#include <mach/clps711x.h>
> +static inline void setup_uart(const u32 bus_speed)
> +{
> +     u32 baud_base = DIV_ROUND_CLOSEST(bus_speed, 10);
> +     u32 baud_divisor =
> +             DIV_ROUND_CLOSEST(baud_base, DEBUG_LL_BAUDRATE * 16) - 1;
> +
> +     writel(baud_divisor | UBRLCR_FIFOEN | UBRLCR_WRDLEN8, UBRLCR1);
> +     writel(0, STFCLR);
> +     writel(SYSCON_UARTEN, SYSCON1);
>  
> -void __naked __bare_init clps711x_barebox_entry(u32 pllmult, void *data)
> +     putc_ll('>');
> +}
> +
> +void clps711x_start(void *fdt)
>  {
> -     u32 cpu, bus;
> +     u32 bus, pll;
>  
>       /* Check if we running from external 13 MHz clock */
>       if (!(readl(SYSFLG2) & SYSFLG2_CKMODE)) {
> @@ -27,24 +33,17 @@ void __naked __bare_init clps711x_barebox_entry(u32 
> pllmult, void *data)
>               writel(SYSCON3_CLKCTL0 | SYSCON3_CLKCTL1, SYSCON3);
>               asm("nop");
>  
> -             /* Check valid multiplier, default to 74 MHz */
> -             if ((pllmult < 20) || (pllmult > 50))
> -                     pllmult = 40;
> +             if (IS_ENABLED(CONFIG_CLPS711X_RAISE_CPUFREQ)) {
> +                     /* Setup PLL to 92160000 Hz */
> +                     writel(50 << 24, PLLW);
> +                     asm("nop");
> +             }
>  
> -             /* Setup PLL */
> -             writel(pllmult << 24, PLLW);
> -             asm("nop");
> -
> -             /* Check for old CPUs without PLL */
> -             if ((readl(PLLR) >> 24) != pllmult)
> -                     cpu = 73728000;
> -             else
> -                     cpu = pllmult * 3686400;
> -
> -             if (cpu >= 36864000)
> -                     bus = cpu / 2;
> +             pll = readl(PLLR) >> 24;
> +             if (pll)
> +                     bus = (pll * 3686400) / 4;
>               else
> -                     bus = 36864000 / 2;
> +                     bus = 73728000 / 4;
>       } else {
>               bus = 13000000;
>               /* Setup bus wait state scaling factor to 1  */
> @@ -52,6 +51,13 @@ void __naked __bare_init clps711x_barebox_entry(u32 
> pllmult, void *data)
>               asm("nop");
>       }
>  
> +
> +     /* Disable UART, IrDa, LCD */
> +     writel(0, SYSCON1);
> +
> +     if (IS_ENABLED(CONFIG_DEBUG_LL))
> +             setup_uart(bus);
> +
>       /* CLKEN select, SDRAM width=32 */
>       writel(SYSCON2_CLKENSL, SYSCON2);
>  
> @@ -62,12 +68,10 @@ void __naked __bare_init clps711x_barebox_entry(u32 
> pllmult, void *data)
>       /* Setup Refresh Rate (64ms 8K Blocks) */
>       writel((64 * bus) / (8192 * 1000), SDRFPR);
>  
> -     /* Disable UART, IrDa, LCD */
> -     writel(0, SYSCON1);
>       /* Disable PWM */
>       writew(0, PMPCON);
>       /* Disable LED flasher */
>       writew(0, LEDFLSH);
>  
> -     barebox_arm_entry(SDRAM0_BASE, SZ_8M, data);
> +     barebox_arm_entry(SDRAM0_BASE, SZ_8M, fdt);
>  }
> diff --git a/arch/arm/mach-clps711x/reset.c b/arch/arm/mach-clps711x/reset.c
> deleted file mode 100644
> index 90ddb8f5d2..0000000000
> --- a/arch/arm/mach-clps711x/reset.c
> +++ /dev/null
> @@ -1,29 +0,0 @@
> -/*
> - * Copyright (C) 2012 Alexander Shiyan <[email protected]>
> - *
> - * This program is free software; you can redistribute it and/or
> - * modify it under the terms of the GNU General Public License as
> - * published by the Free Software Foundation; either version 2 of
> - * the License, or (at your option) any later version.
> - */
> -
> -#include <common.h>
> -#include <init.h>
> -#include <restart.h>
> -
> -static void __noreturn clps711x_restart_soc(struct restart_handler *rst)
> -{
> -     shutdown_barebox();
> -
> -     asm("mov pc, #0");
> -
> -     hang();
> -}
> -
> -static int restart_register_feature(void)
> -{
> -     restart_handler_register_fn("vector", clps711x_restart_soc);
> -
> -     return 0;
> -}
> -coredevice_initcall(restart_register_feature);
> diff --git a/drivers/clocksource/clps711x.c b/drivers/clocksource/clps711x.c
> index 1fe7f6c891..d6ab695afa 100644
> --- a/drivers/clocksource/clps711x.c
> +++ b/drivers/clocksource/clps711x.c
> @@ -27,6 +27,11 @@ static int clps711x_cs_probe(struct device_d *dev)
>       struct resource *iores;
>       u32 rate;
>       struct clk *timer_clk;
> +     int id;
> +
> +     id = of_alias_get_id(dev->device_node, "timer");
> +     if (id != 1)
> +             return 0;
>  
>       timer_clk = clk_get(dev, NULL);
>       if (IS_ERR(timer_clk))
> @@ -46,7 +51,7 @@ static int clps711x_cs_probe(struct device_d *dev)
>       return init_clock(&clps711x_cs);
>  }
>  
> -static __maybe_unused struct of_device_id clps711x_timer_dt_ids[] = {
> +static const struct of_device_id __maybe_unused clps711x_timer_dt_ids[] = {
>       { .compatible = "cirrus,ep7209-timer", },
>       { }
>  };
> diff --git a/drivers/gpio/gpio-clps711x.c b/drivers/gpio/gpio-clps711x.c
> index a1965b33e4..cb4bd4025c 100644
> --- a/drivers/gpio/gpio-clps711x.c
> +++ b/drivers/gpio/gpio-clps711x.c
> @@ -10,13 +10,10 @@
>  static int clps711x_gpio_probe(struct device_d *dev)
>  {
>       struct resource *iores;
> -     int err, id = dev->id;
> +     int err, id = of_alias_get_id(dev->device_node, "gpio");
>       void __iomem *dat, *dir = NULL, *dir_inv = NULL;
>       struct bgpio_chip *bgc;
>  
> -     if (dev->device_node)
> -             id = of_alias_get_id(dev->device_node, "gpio");
> -
>       if (id < 0 || id > 4)
>               return -ENODEV;
>  
> @@ -62,7 +59,7 @@ out_err:
>       return err;
>  }
>  
> -static struct of_device_id __maybe_unused clps711x_gpio_dt_ids[] = {
> +static const struct of_device_id __maybe_unused clps711x_gpio_dt_ids[] = {
>       { .compatible = "cirrus,ep7209-gpio", },
>       { /* sentinel */ }
>  };
> diff --git a/drivers/serial/serial_clps711x.c 
> b/drivers/serial/serial_clps711x.c
> index 7aac0970bf..cb7043d8e0 100644
> --- a/drivers/serial/serial_clps711x.c
> +++ b/drivers/serial/serial_clps711x.c
> @@ -35,7 +35,7 @@
>  
>  struct clps711x_uart {
>       void __iomem            *base;
> -     void __iomem            *syscon;
> +     struct regmap           *regmap;
>       struct clk              *uart_clk;
>       struct console_device   cdev;
>  };
> @@ -61,8 +61,7 @@ static void clps711x_init_port(struct console_device *cdev)
>       u32 tmp;
>  
>       /* Disable the UART */
> -     tmp = readl(s->syscon + SYSCON);
> -     writel(tmp & ~SYSCON_UARTEN, s->syscon + SYSCON);
> +     regmap_update_bits(s->regmap, SYSCON, SYSCON_UARTEN, 0);
>  
>       /* Setup Line Control Register */
>       tmp = readl(s->base + UBRLCR) & UBRLCR_BAUD_MASK;
> @@ -70,17 +69,19 @@ static void clps711x_init_port(struct console_device 
> *cdev)
>       writel(tmp, s->base + UBRLCR);
>  
>       /* Enable the UART */
> -     tmp = readl(s->syscon + SYSCON);
> -     writel(tmp | SYSCON_UARTEN, s->syscon + SYSCON);
> +     regmap_update_bits(s->regmap, SYSCON, SYSCON_UARTEN, SYSCON_UARTEN);
>  }
>  
>  static void clps711x_putc(struct console_device *cdev, char c)
>  {
>       struct clps711x_uart *s = cdev->dev->priv;
> +     u32 tmp;
>  
>       /* Wait until there is space in the FIFO */
>       do {
> -     } while (readl(s->syscon + SYSFLG) & SYSFLG_UTXFF);
> +             regmap_read(s->regmap, SYSFLG, &tmp);
> +             
> +     } while (tmp & SYSFLG_UTXFF);
>  
>       /* Send the character */
>       writew(c, s->base + UARTDR);
> @@ -90,10 +91,12 @@ static int clps711x_getc(struct console_device *cdev)
>  {
>       struct clps711x_uart *s = cdev->dev->priv;
>       u16 data;
> +     u32 tmp;
>  
>       /* Wait until there is data in the FIFO */
>       do {
> -     } while (readl(s->syscon + SYSFLG) & SYSFLG_URXFE);
> +             regmap_read(s->regmap, SYSFLG, &tmp);
> +     } while (tmp & SYSFLG_URXFE);
>  
>       data = readw(s->base + UARTDR);
>  
> @@ -107,32 +110,32 @@ static int clps711x_getc(struct console_device *cdev)
>  static int clps711x_tstc(struct console_device *cdev)
>  {
>       struct clps711x_uart *s = cdev->dev->priv;
> +     u32 tmp;
>  
> -     return !(readl(s->syscon + SYSFLG) & SYSFLG_URXFE);
> +     regmap_read(s->regmap, SYSFLG, &tmp);
> +
> +     return !(tmp & SYSFLG_URXFE);
>  }
>  
>  static void clps711x_flush(struct console_device *cdev)
>  {
>       struct clps711x_uart *s = cdev->dev->priv;
> +     u32 tmp;
>  
>       do {
> -     } while (readl(s->syscon + SYSFLG) & SYSFLG_UBUSY);
> +             regmap_read(s->regmap, SYSFLG, &tmp);
> +     } while (tmp & SYSFLG_UBUSY);
>  }
>  
>  static int clps711x_probe(struct device_d *dev)
>  {
> +     struct device_node *syscon;
>       struct clps711x_uart *s;
> -     int err, id = dev->id;
> -     char syscon_dev[8];
>       const char *devname;
> -
> -     if (dev->device_node)
> -             id = of_alias_get_id(dev->device_node, "serial");
> -
> -     if (id != 0 && id != 1)
> -             return -EINVAL;
> +     int err;
>  
>       s = xzalloc(sizeof(struct clps711x_uart));
> +
>       s->uart_clk = clk_get(dev, NULL);
>       if (IS_ERR(s->uart_clk)) {
>               err = PTR_ERR(s->uart_clk);
> @@ -140,19 +143,15 @@ static int clps711x_probe(struct device_d *dev)
>       }
>  
>       s->base = dev_get_mem_region(dev, 0);
> -     if (IS_ERR(s->base))
> -             return PTR_ERR(s->base);
> -
> -     if (!dev->device_node) {
> -             sprintf(syscon_dev, "syscon%i", id + 1);
> -             s->syscon = syscon_base_lookup_by_pdevname(syscon_dev);
> -     } else {
> -             s->syscon = syscon_base_lookup_by_phandle(dev->device_node,
> -                                                       "syscon");
> +     if (IS_ERR(s->base)) {
> +             err = PTR_ERR(s->base);
> +             goto out_err;
>       }
>  
> -     if (IS_ERR(s->syscon)) {
> -             err = PTR_ERR(s->syscon);
> +     syscon = of_parse_phandle(dev->device_node, "syscon", 0);
> +     s->regmap = syscon_node_to_regmap(syscon);
> +     if (IS_ERR(s->regmap)) {
> +             err = PTR_ERR(s->regmap);
>               goto out_err;
>       }
>  
> @@ -182,7 +181,7 @@ out_err:
>       return err;
>  }
>  
> -static struct of_device_id __maybe_unused clps711x_uart_dt_ids[] = {
> +static const struct of_device_id __maybe_unused clps711x_uart_dt_ids[] = {
>       { .compatible = "cirrus,ep7209-uart", },
>       { /* sentinel */ }
>  };
> diff --git a/images/Makefile b/images/Makefile
> index 5e2b9ecaaa..a148cf4176 100644
> --- a/images/Makefile
> +++ b/images/Makefile
> @@ -152,6 +152,7 @@ include $(srctree)/images/Makefile.ar231x
>  include $(srctree)/images/Makefile.ath79
>  include $(srctree)/images/Makefile.bcm283x
>  include $(srctree)/images/Makefile.bcm47xx
> +include $(srctree)/images/Makefile.clps711x
>  include $(srctree)/images/Makefile.imx
>  include $(srctree)/images/Makefile.loongson
>  include $(srctree)/images/Makefile.malta
> diff --git a/images/Makefile.clps711x b/images/Makefile.clps711x
> new file mode 100644
> index 0000000000..d76911d627
> --- /dev/null
> +++ b/images/Makefile.clps711x
> @@ -0,0 +1,8 @@
> +# SPDX-License-Identifier: GPL-2.0-only
> +#
> +# barebox image generation Makefile for CLPS711X images
> +#
> +
> +pblb-$(CONFIG_MACH_CLEP7212) += start_ep7212_clep7212
> +FILE_barebox-ep7212-clep7212.img = start_ep7212_clep7212.pblb
> +image-$(CONFIG_MACH_CLEP7212) += barebox-ep7212-clep7212.img
> -- 
> 2.32.0
> 
> 
> _______________________________________________
> barebox mailing list
> [email protected]
> http://lists.infradead.org/mailman/listinfo/barebox
> 

-- 
Pengutronix e.K.                           |                             |
Steuerwalder Str. 21                       | http://www.pengutronix.de/  |
31137 Hildesheim, Germany                  | Phone: +49-5121-206917-0    |
Amtsgericht Hildesheim, HRA 2686           | Fax:   +49-5121-206917-5555 |

_______________________________________________
barebox mailing list
[email protected]
http://lists.infradead.org/mailman/listinfo/barebox

Reply via email to