mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-07-10 13:16:16 +09:00
41575d8e4c
This construct is quite long-winded. In earlier days it made some sense since auto-allocation was a strange concept. But with driver model now used pretty universally, we can shorten this to 'auto'. This reduces verbosity and makes it easier to read. Coincidentally it also ensures that every declaration is on one line, thus making dtoc's job easier. Signed-off-by: Simon Glass <sjg@chromium.org>
95 lines
2.0 KiB
C
95 lines
2.0 KiB
C
// SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause
|
|
/*
|
|
* Copyright (C) 2018, STMicroelectronics - All Rights Reserved
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <clk.h>
|
|
#include <dm.h>
|
|
#include <hwspinlock.h>
|
|
#include <malloc.h>
|
|
#include <asm/io.h>
|
|
#include <linux/bitops.h>
|
|
|
|
#define STM32_MUTEX_COREID BIT(8)
|
|
#define STM32_MUTEX_LOCK_BIT BIT(31)
|
|
#define STM32_MUTEX_NUM_LOCKS 32
|
|
|
|
struct stm32mp1_hws_priv {
|
|
fdt_addr_t base;
|
|
};
|
|
|
|
static int stm32mp1_lock(struct udevice *dev, int index)
|
|
{
|
|
struct stm32mp1_hws_priv *priv = dev_get_priv(dev);
|
|
u32 status;
|
|
|
|
if (index >= STM32_MUTEX_NUM_LOCKS)
|
|
return -EINVAL;
|
|
|
|
status = readl(priv->base + index * sizeof(u32));
|
|
if (status == (STM32_MUTEX_LOCK_BIT | STM32_MUTEX_COREID))
|
|
return -EBUSY;
|
|
|
|
writel(STM32_MUTEX_LOCK_BIT | STM32_MUTEX_COREID,
|
|
priv->base + index * sizeof(u32));
|
|
|
|
status = readl(priv->base + index * sizeof(u32));
|
|
if (status != (STM32_MUTEX_LOCK_BIT | STM32_MUTEX_COREID))
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int stm32mp1_unlock(struct udevice *dev, int index)
|
|
{
|
|
struct stm32mp1_hws_priv *priv = dev_get_priv(dev);
|
|
|
|
if (index >= STM32_MUTEX_NUM_LOCKS)
|
|
return -EINVAL;
|
|
|
|
writel(STM32_MUTEX_COREID, priv->base + index * sizeof(u32));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int stm32mp1_hwspinlock_probe(struct udevice *dev)
|
|
{
|
|
struct stm32mp1_hws_priv *priv = dev_get_priv(dev);
|
|
struct clk clk;
|
|
int ret;
|
|
|
|
priv->base = dev_read_addr(dev);
|
|
if (priv->base == FDT_ADDR_T_NONE)
|
|
return -EINVAL;
|
|
|
|
ret = clk_get_by_index(dev, 0, &clk);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = clk_enable(&clk);
|
|
if (ret)
|
|
clk_free(&clk);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static const struct hwspinlock_ops stm32mp1_hwspinlock_ops = {
|
|
.lock = stm32mp1_lock,
|
|
.unlock = stm32mp1_unlock,
|
|
};
|
|
|
|
static const struct udevice_id stm32mp1_hwspinlock_ids[] = {
|
|
{ .compatible = "st,stm32-hwspinlock" },
|
|
{}
|
|
};
|
|
|
|
U_BOOT_DRIVER(hwspinlock_stm32mp1) = {
|
|
.name = "hwspinlock_stm32mp1",
|
|
.id = UCLASS_HWSPINLOCK,
|
|
.of_match = stm32mp1_hwspinlock_ids,
|
|
.ops = &stm32mp1_hwspinlock_ops,
|
|
.probe = stm32mp1_hwspinlock_probe,
|
|
.priv_auto = sizeof(struct stm32mp1_hws_priv),
|
|
};
|