mirror of
https://github.com/u-boot/u-boot.git
synced 2025-04-25 14:56:03 +00: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 commitc8ffd1356d, reversing changes made to2ee6f3a5f7. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
129 lines
2.4 KiB
C
129 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",
|
|
};
|