mirror of
https://github.com/riscv-software-src/opensbi.git
synced 2025-08-25 15:51:41 +01:00
Compare commits
5 Commits
Author | SHA1 | Date | |
---|---|---|---|
![]() |
057eb10b6d | ||
![]() |
c6a35733b7 | ||
![]() |
7828eebaaa | ||
![]() |
eb736a5118 | ||
![]() |
0907de38db |
@@ -933,6 +933,8 @@ int sbi_pmu_init(struct sbi_scratch *scratch, bool cold_boot)
|
|||||||
|
|
||||||
/* mcycle & minstret is available always */
|
/* mcycle & minstret is available always */
|
||||||
num_hw_ctrs = sbi_hart_mhpm_count(scratch) + 3;
|
num_hw_ctrs = sbi_hart_mhpm_count(scratch) + 3;
|
||||||
|
if (num_hw_ctrs > SBI_PMU_HW_CTR_MAX)
|
||||||
|
return SBI_EINVAL;
|
||||||
total_ctrs = num_hw_ctrs + SBI_PMU_FW_CTR_MAX;
|
total_ctrs = num_hw_ctrs + SBI_PMU_FW_CTR_MAX;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@@ -10,6 +10,10 @@ config FDT_GPIO
|
|||||||
|
|
||||||
if FDT_GPIO
|
if FDT_GPIO
|
||||||
|
|
||||||
|
config FDT_GPIO_DESIGNWARE
|
||||||
|
bool "DesignWare GPIO driver"
|
||||||
|
default n
|
||||||
|
|
||||||
config FDT_GPIO_SIFIVE
|
config FDT_GPIO_SIFIVE
|
||||||
bool "SiFive GPIO FDT driver"
|
bool "SiFive GPIO FDT driver"
|
||||||
default n
|
default n
|
||||||
|
140
lib/utils/gpio/fdt_gpio_designware.c
Normal file
140
lib/utils/gpio/fdt_gpio_designware.c
Normal file
@@ -0,0 +1,140 @@
|
|||||||
|
/*
|
||||||
|
* SPDX-License-Identifier: BSD-2-Clause
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022 SiFive
|
||||||
|
*
|
||||||
|
* GPIO driver for Synopsys DesignWare APB GPIO
|
||||||
|
*
|
||||||
|
* Authors:
|
||||||
|
* Ben Dooks <ben.dooks@sifive.com>
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <libfdt.h>
|
||||||
|
|
||||||
|
#include <sbi/riscv_io.h>
|
||||||
|
#include <sbi/sbi_error.h>
|
||||||
|
|
||||||
|
#include <sbi_utils/fdt/fdt_helper.h>
|
||||||
|
#include <sbi_utils/gpio/fdt_gpio.h>
|
||||||
|
|
||||||
|
#define DW_GPIO_CHIP_MAX 4 /* need 1 per bank in use */
|
||||||
|
#define DW_GPIO_PINS_MAX 32
|
||||||
|
|
||||||
|
#define DW_GPIO_DDR 0x4
|
||||||
|
#define DW_GPIO_DR 0x0
|
||||||
|
#define DW_GPIO_BIT(_b) (1UL << (_b))
|
||||||
|
|
||||||
|
struct dw_gpio_chip {
|
||||||
|
void *dr;
|
||||||
|
void *ext;
|
||||||
|
struct gpio_chip chip;
|
||||||
|
};
|
||||||
|
|
||||||
|
extern struct fdt_gpio fdt_gpio_designware;
|
||||||
|
|
||||||
|
static unsigned int dw_gpio_chip_count;
|
||||||
|
static struct dw_gpio_chip dw_gpio_chip_array[DW_GPIO_CHIP_MAX];
|
||||||
|
|
||||||
|
#define pin_to_chip(__p) container_of((__p)->chip, struct dw_gpio_chip, chip);
|
||||||
|
|
||||||
|
static int dw_gpio_direction_output(struct gpio_pin *gp, int value)
|
||||||
|
{
|
||||||
|
struct dw_gpio_chip *chip = pin_to_chip(gp);
|
||||||
|
unsigned long v;
|
||||||
|
|
||||||
|
v = readl(chip->dr + DW_GPIO_DR);
|
||||||
|
if (!value)
|
||||||
|
v &= ~DW_GPIO_BIT(gp->offset);
|
||||||
|
else
|
||||||
|
v |= DW_GPIO_BIT(gp->offset);
|
||||||
|
writel(v, chip->dr + DW_GPIO_DR);
|
||||||
|
|
||||||
|
/* the DR is output only so we can set it then the DDR to set
|
||||||
|
* the data direction, to avoid glitches.
|
||||||
|
*/
|
||||||
|
v = readl(chip->dr + DW_GPIO_DDR);
|
||||||
|
v |= DW_GPIO_BIT(gp->offset);
|
||||||
|
writel(v, chip->dr + DW_GPIO_DDR);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void dw_gpio_set(struct gpio_pin *gp, int value)
|
||||||
|
{
|
||||||
|
struct dw_gpio_chip *chip = pin_to_chip(gp);
|
||||||
|
unsigned long v;
|
||||||
|
|
||||||
|
v = readl(chip->dr + DW_GPIO_DR);
|
||||||
|
if (!value)
|
||||||
|
v &= ~DW_GPIO_BIT(gp->offset);
|
||||||
|
else
|
||||||
|
v |= DW_GPIO_BIT(gp->offset);
|
||||||
|
writel(v, chip->dr + DW_GPIO_DR);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* notes:
|
||||||
|
* each sub node is a bank and has ngpios or snpns,nr-gpios and a reg property
|
||||||
|
* with the compatible `snps,dw-apb-gpio-port`.
|
||||||
|
* bank A is the only one with irq support but we're not using it here
|
||||||
|
*/
|
||||||
|
|
||||||
|
static int dw_gpio_init_bank(void *fdt, int nodeoff, u32 phandle,
|
||||||
|
const struct fdt_match *match)
|
||||||
|
{
|
||||||
|
struct dw_gpio_chip *chip;
|
||||||
|
const fdt32_t *val;
|
||||||
|
uint64_t addr;
|
||||||
|
int rc, poff, nr_pins, bank, len;
|
||||||
|
|
||||||
|
if (dw_gpio_chip_count >= DW_GPIO_CHIP_MAX)
|
||||||
|
return SBI_ENOSPC;
|
||||||
|
|
||||||
|
/* need to get parent for the address property */
|
||||||
|
poff = fdt_parent_offset(fdt, nodeoff);
|
||||||
|
if (poff < 0)
|
||||||
|
return SBI_EINVAL;
|
||||||
|
|
||||||
|
rc = fdt_get_node_addr_size(fdt, poff, 0, &addr, NULL);
|
||||||
|
if (rc)
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
val = fdt_getprop(fdt, nodeoff, "reg", &len);
|
||||||
|
if (!val || len <= 0)
|
||||||
|
return SBI_EINVAL;
|
||||||
|
bank = fdt32_to_cpu(*val);
|
||||||
|
|
||||||
|
val = fdt_getprop(fdt, nodeoff, "snps,nr-gpios", &len);
|
||||||
|
if (!val)
|
||||||
|
val = fdt_getprop(fdt, nodeoff, "ngpios", &len);
|
||||||
|
if (!val || len <= 0)
|
||||||
|
return SBI_EINVAL;
|
||||||
|
nr_pins = fdt32_to_cpu(*val);
|
||||||
|
|
||||||
|
chip = &dw_gpio_chip_array[dw_gpio_chip_count];
|
||||||
|
|
||||||
|
chip->dr = (void *)(uintptr_t)addr + (bank * 0xc);
|
||||||
|
chip->ext = (void *)(uintptr_t)addr + (bank * 4) + 0x50;
|
||||||
|
chip->chip.driver = &fdt_gpio_designware;
|
||||||
|
chip->chip.id = phandle;
|
||||||
|
chip->chip.ngpio = nr_pins;
|
||||||
|
chip->chip.set = dw_gpio_set;
|
||||||
|
chip->chip.direction_output = dw_gpio_direction_output;
|
||||||
|
rc = gpio_chip_add(&chip->chip);
|
||||||
|
if (rc)
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
dw_gpio_chip_count++;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* since we're only probed when used, match on port not main controller node */
|
||||||
|
static const struct fdt_match dw_gpio_match[] = {
|
||||||
|
{ .compatible = "snps,dw-apb-gpio-port" },
|
||||||
|
{ },
|
||||||
|
};
|
||||||
|
|
||||||
|
struct fdt_gpio fdt_gpio_designware = {
|
||||||
|
.match_table = dw_gpio_match,
|
||||||
|
.xlate = fdt_gpio_simple_xlate,
|
||||||
|
.init = dw_gpio_init_bank,
|
||||||
|
};
|
@@ -10,6 +10,9 @@
|
|||||||
libsbiutils-objs-$(CONFIG_FDT_GPIO) += gpio/fdt_gpio.o
|
libsbiutils-objs-$(CONFIG_FDT_GPIO) += gpio/fdt_gpio.o
|
||||||
libsbiutils-objs-$(CONFIG_FDT_GPIO) += gpio/fdt_gpio_drivers.o
|
libsbiutils-objs-$(CONFIG_FDT_GPIO) += gpio/fdt_gpio_drivers.o
|
||||||
|
|
||||||
|
carray-fdt_gpio_drivers-$(CONFIG_FDT_GPIO_DESIGNWARE) += fdt_gpio_designware
|
||||||
|
libsbiutils-objs-$(CONFIG_FDT_GPIO_DESIGNWARE) += gpio/fdt_gpio_designware.o
|
||||||
|
|
||||||
carray-fdt_gpio_drivers-$(CONFIG_FDT_GPIO_SIFIVE) += fdt_gpio_sifive
|
carray-fdt_gpio_drivers-$(CONFIG_FDT_GPIO_SIFIVE) += fdt_gpio_sifive
|
||||||
libsbiutils-objs-$(CONFIG_FDT_GPIO_SIFIVE) += gpio/fdt_gpio_sifive.o
|
libsbiutils-objs-$(CONFIG_FDT_GPIO_SIFIVE) += gpio/fdt_gpio_sifive.o
|
||||||
|
|
||||||
|
@@ -101,8 +101,13 @@ int aclint_mswi_cold_init(struct aclint_mswi_data *mswi)
|
|||||||
/* Update MSWI pointer in scratch space */
|
/* Update MSWI pointer in scratch space */
|
||||||
for (i = 0; i < mswi->hart_count; i++) {
|
for (i = 0; i < mswi->hart_count; i++) {
|
||||||
scratch = sbi_hartid_to_scratch(mswi->first_hartid + i);
|
scratch = sbi_hartid_to_scratch(mswi->first_hartid + i);
|
||||||
|
/*
|
||||||
|
* We don't need to fail if scratch pointer is not available
|
||||||
|
* because we might be dealing with hartid of a HART disabled
|
||||||
|
* in the device tree.
|
||||||
|
*/
|
||||||
if (!scratch)
|
if (!scratch)
|
||||||
return SBI_ENOENT;
|
continue;
|
||||||
mswi_set_hart_data_ptr(scratch, mswi);
|
mswi_set_hart_data_ptr(scratch, mswi);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@@ -219,8 +219,13 @@ int aclint_mtimer_cold_init(struct aclint_mtimer_data *mt,
|
|||||||
/* Update MTIMER pointer in scratch space */
|
/* Update MTIMER pointer in scratch space */
|
||||||
for (i = 0; i < mt->hart_count; i++) {
|
for (i = 0; i < mt->hart_count; i++) {
|
||||||
scratch = sbi_hartid_to_scratch(mt->first_hartid + i);
|
scratch = sbi_hartid_to_scratch(mt->first_hartid + i);
|
||||||
|
/*
|
||||||
|
* We don't need to fail if scratch pointer is not available
|
||||||
|
* because we might be dealing with hartid of a HART disabled
|
||||||
|
* in the device tree.
|
||||||
|
*/
|
||||||
if (!scratch)
|
if (!scratch)
|
||||||
return SBI_ENOENT;
|
continue;
|
||||||
mtimer_set_hart_data_ptr(scratch, mt);
|
mtimer_set_hart_data_ptr(scratch, mt);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@@ -5,6 +5,7 @@ CONFIG_PLATFORM_SIFIVE_FU540=y
|
|||||||
CONFIG_PLATFORM_SIFIVE_FU740=y
|
CONFIG_PLATFORM_SIFIVE_FU740=y
|
||||||
CONFIG_PLATFORM_STARFIVE_JH7110=y
|
CONFIG_PLATFORM_STARFIVE_JH7110=y
|
||||||
CONFIG_FDT_GPIO=y
|
CONFIG_FDT_GPIO=y
|
||||||
|
CONFIG_FDT_GPIO_DESIGNWARE=y
|
||||||
CONFIG_FDT_GPIO_SIFIVE=y
|
CONFIG_FDT_GPIO_SIFIVE=y
|
||||||
CONFIG_FDT_GPIO_STARFIVE=y
|
CONFIG_FDT_GPIO_STARFIVE=y
|
||||||
CONFIG_FDT_I2C=y
|
CONFIG_FDT_I2C=y
|
||||||
|
Reference in New Issue
Block a user