mirror of
https://github.com/smaeul/u-boot.git
synced 2025-10-18 22:58:13 +01:00
d678a59d2d
When bringing in the series 'arm: dts: am62-beagleplay: Fix Beagleplay Ethernet"' I failed to notice that b4 noticed it was based on next and so took that as the base commit and merged that part of next to master. This reverts commit c8ffd1356d42223cbb8c86280a083cc3c93e6426, reversing changes made to 2ee6f3a5f7550de3599faef9704e166e5dcace35. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
130 lines
2.4 KiB
C
130 lines
2.4 KiB
C
// SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause
|
|
/*
|
|
* Copyright (C) 2018, STMicroelectronics - All Rights Reserved
|
|
*/
|
|
|
|
#define LOG_CATEGORY UCLASS_HWSPINLOCK
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <errno.h>
|
|
#include <hwspinlock.h>
|
|
#include <log.h>
|
|
#include <dm/device-internal.h>
|
|
#include <dm/device_compat.h>
|
|
#include <linux/compat.h>
|
|
#include <asm/global_data.h>
|
|
|
|
static inline const struct hwspinlock_ops *
|
|
hwspinlock_dev_ops(struct udevice *dev)
|
|
{
|
|
return (const struct hwspinlock_ops *)dev->driver->ops;
|
|
}
|
|
|
|
static int hwspinlock_of_xlate_default(struct hwspinlock *hws,
|
|
struct ofnode_phandle_args *args)
|
|
{
|
|
if (args->args_count > 1) {
|
|
debug("Invalid args_count: %d\n", args->args_count);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (args->args_count)
|
|
hws->id = args->args[0];
|
|
else
|
|
hws->id = 0;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int hwspinlock_get_by_index(struct udevice *dev, int index,
|
|
struct hwspinlock *hws)
|
|
{
|
|
int ret;
|
|
struct ofnode_phandle_args args;
|
|
struct udevice *dev_hws;
|
|
const struct hwspinlock_ops *ops;
|
|
|
|
assert(hws);
|
|
hws->dev = NULL;
|
|
|
|
ret = dev_read_phandle_with_args(dev, "hwlocks", "#hwlock-cells", 1,
|
|
index, &args);
|
|
if (ret) {
|
|
dev_dbg(dev, "%s: dev_read_phandle_with_args: err=%d\n",
|
|
__func__, ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = uclass_get_device_by_ofnode(UCLASS_HWSPINLOCK,
|
|
args.node, &dev_hws);
|
|
if (ret) {
|
|
dev_dbg(dev,
|
|
"%s: uclass_get_device_by_of_offset failed: err=%d\n",
|
|
__func__, ret);
|
|
return ret;
|
|
}
|
|
|
|
hws->dev = dev_hws;
|
|
|
|
ops = hwspinlock_dev_ops(dev_hws);
|
|
|
|
if (ops->of_xlate)
|
|
ret = ops->of_xlate(hws, &args);
|
|
else
|
|
ret = hwspinlock_of_xlate_default(hws, &args);
|
|
if (ret)
|
|
dev_dbg(dev, "of_xlate() failed: %d\n", ret);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int hwspinlock_lock_timeout(struct hwspinlock *hws, unsigned int timeout)
|
|
{
|
|
const struct hwspinlock_ops *ops;
|
|
ulong start;
|
|
int ret;
|
|
|
|
assert(hws);
|
|
|
|
if (!hws->dev)
|
|
return -EINVAL;
|
|
|
|
ops = hwspinlock_dev_ops(hws->dev);
|
|
if (!ops->lock)
|
|
return -ENOSYS;
|
|
|
|
start = get_timer(0);
|
|
do {
|
|
ret = ops->lock(hws->dev, hws->id);
|
|
if (!ret)
|
|
return ret;
|
|
|
|
if (ops->relax)
|
|
ops->relax(hws->dev);
|
|
} while (get_timer(start) < timeout);
|
|
|
|
return -ETIMEDOUT;
|
|
}
|
|
|
|
int hwspinlock_unlock(struct hwspinlock *hws)
|
|
{
|
|
const struct hwspinlock_ops *ops;
|
|
|
|
assert(hws);
|
|
|
|
if (!hws->dev)
|
|
return -EINVAL;
|
|
|
|
ops = hwspinlock_dev_ops(hws->dev);
|
|
if (!ops->unlock)
|
|
return -ENOSYS;
|
|
|
|
return ops->unlock(hws->dev, hws->id);
|
|
}
|
|
|
|
UCLASS_DRIVER(hwspinlock) = {
|
|
.id = UCLASS_HWSPINLOCK,
|
|
.name = "hwspinlock",
|
|
};
|