mirror of
https://source.denx.de/u-boot/u-boot.git
synced 2025-08-10 09:17:00 +02: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>
77 lines
1.5 KiB
C
77 lines
1.5 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (c) 2023 SberDevices, Inc.
|
|
*
|
|
* Author: Alexey Romanov <avromanov@salutedevices.com>
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <sm.h>
|
|
#include <sm-uclass.h>
|
|
#include <sandbox-sm.h>
|
|
#include <asm/ptrace.h>
|
|
#include <dm/device.h>
|
|
#include <linux/sizes.h>
|
|
|
|
static u8 test_buffer[SZ_4K];
|
|
|
|
static int sandbox_sm_call(struct udevice *dev, u32 cmd_index, s32 *smc_ret,
|
|
struct pt_regs *args)
|
|
{
|
|
if (cmd_index >= SANDBOX_SMC_CMD_COUNT)
|
|
return -EINVAL;
|
|
|
|
if (smc_ret)
|
|
*smc_ret = 0;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sandbox_sm_call_read(struct udevice *dev, void *buffer, size_t size,
|
|
u32 cmd_index, struct pt_regs *args)
|
|
{
|
|
if (cmd_index >= SANDBOX_SMC_CMD_COUNT || !buffer)
|
|
return -EINVAL;
|
|
|
|
if (size > sizeof(test_buffer))
|
|
return -EINVAL;
|
|
|
|
memcpy(buffer, test_buffer, size);
|
|
|
|
return size;
|
|
}
|
|
|
|
static int sandbox_sm_call_write(struct udevice *dev, void *buffer, size_t size,
|
|
u32 cmd_index, struct pt_regs *args)
|
|
{
|
|
if (cmd_index >= SANDBOX_SMC_CMD_COUNT || !buffer)
|
|
return -EINVAL;
|
|
|
|
if (size > sizeof(test_buffer))
|
|
return -EINVAL;
|
|
|
|
memcpy(test_buffer, buffer, size);
|
|
|
|
return size;
|
|
}
|
|
|
|
static const struct udevice_id sandbox_sm_ids[] = {
|
|
{
|
|
.compatible = "sandbox,sm",
|
|
},
|
|
{},
|
|
};
|
|
|
|
static const struct sm_ops sandbox_sm_ops = {
|
|
.sm_call = sandbox_sm_call,
|
|
.sm_call_read = sandbox_sm_call_read,
|
|
.sm_call_write = sandbox_sm_call_write,
|
|
};
|
|
|
|
U_BOOT_DRIVER(sm) = {
|
|
.name = "sm",
|
|
.id = UCLASS_SM,
|
|
.of_match = sandbox_sm_ids,
|
|
.ops = &sandbox_sm_ops,
|
|
};
|