mirror of
https://github.com/hardkernel/kernel_common_drivers.git
synced 2026-06-25 12:03:48 +09:00
qiankun.wang
0335d01014
PD#SWPL-129901 Problem: IO-R-E can't read the register's data. Solution: when the "read" action is over, the hook function will get the value from the action. Verify: SC2 Change-Id: I12426209bf92e5c242022041e01ed6a7711808dc Signed-off-by: qiankun.wang <qiankun.wang@amlogic.com>
77 lines
2.2 KiB
C
77 lines
2.2 KiB
C
/* SPDX-License-Identifier: (GPL-2.0+ OR MIT) */
|
|
/*
|
|
* Copyright (c) 2019 Amlogic, Inc. All rights reserved.
|
|
*/
|
|
|
|
#ifndef __AMLOGIC_ASM_IO_32_H
|
|
#define __AMLOGIC_ASM_IO_32_H
|
|
|
|
#include <linux/amlogic/aml_iotrace.h>
|
|
|
|
#define __raw_writew __raw_writew
|
|
static inline void __raw_writew(u16 val, volatile void __iomem *addr)
|
|
{
|
|
pstore_ftrace_io_wr((unsigned long)addr, (unsigned long)val);
|
|
asm volatile("strh %1, %0"
|
|
: : "Q" (*(volatile u16 __force *)addr), "r" (val));
|
|
pstore_ftrace_io_wr_end((unsigned long)addr, (unsigned long)val);
|
|
}
|
|
|
|
#define __raw_readw __raw_readw
|
|
static inline u16 __raw_readw(const volatile void __iomem *addr)
|
|
{
|
|
u16 val;
|
|
|
|
pstore_ftrace_io_rd((unsigned long)addr);
|
|
asm volatile("ldrh %0, %1"
|
|
: "=r" (val)
|
|
: "Q" (*(volatile u16 __force *)addr));
|
|
pstore_ftrace_io_rd_end((unsigned long)addr, (unsigned long)val);
|
|
return val;
|
|
}
|
|
|
|
#define __raw_writeb __raw_writeb
|
|
static inline void __raw_writeb(u8 val, volatile void __iomem *addr)
|
|
{
|
|
pstore_ftrace_io_wr((unsigned long)addr, (unsigned long)val);
|
|
asm volatile("strb %1, %0"
|
|
: : "Qo" (*(volatile u8 __force *)addr), "r" (val));
|
|
pstore_ftrace_io_wr_end((unsigned long)addr, (unsigned long)val);
|
|
}
|
|
|
|
#define __raw_writel __raw_writel
|
|
static inline void __raw_writel(u32 val, volatile void __iomem *addr)
|
|
{
|
|
pstore_ftrace_io_wr((unsigned long)addr, (unsigned long)val);
|
|
asm volatile("str %1, %0"
|
|
: : "Qo" (*(volatile u32 __force *)addr), "r" (val));
|
|
pstore_ftrace_io_wr_end((unsigned long)addr, (unsigned long)val);
|
|
}
|
|
|
|
#define __raw_readb __raw_readb
|
|
static inline u8 __raw_readb(const volatile void __iomem *addr)
|
|
{
|
|
u8 val;
|
|
|
|
pstore_ftrace_io_rd((unsigned long)addr);
|
|
asm volatile("ldrb %0, %1"
|
|
: "=r" (val)
|
|
: "Qo" (*(volatile u8 __force *)addr));
|
|
pstore_ftrace_io_rd_end((unsigned long)addr, (unsigned long)val);
|
|
return val;
|
|
}
|
|
|
|
#define __raw_readl __raw_readl
|
|
static inline u32 __raw_readl(const volatile void __iomem *addr)
|
|
{
|
|
u32 val;
|
|
|
|
pstore_ftrace_io_rd((unsigned long)addr);
|
|
asm volatile("ldr %0, %1"
|
|
: "=r" (val)
|
|
: "Qo" (*(volatile u32 __force *)addr));
|
|
pstore_ftrace_io_rd_end((unsigned long)addr, (unsigned long)val);
|
|
return val;
|
|
}
|
|
#endif /* __AMLOGIC_ASM_IO_32_H */
|