Loading...
/* SPDX-License-Identifier: GPL-2.0 */ /* * Copyright (C) 2020-2022 Loongson Technology Corporation Limited */ #include <linux/linkage.h> #include <asm/asm.h> #include <asm/asmmacro.h> #include <asm/asm-extable.h> #include <asm/errno.h> #include <asm/regdef.h> .L_fixup_handle_unaligned: li.w a0, -EFAULT jr ra /* * unsigned long unaligned_read(void *addr, void *value, unsigned long n, bool sign) * * a0: addr * a1: value * a2: n * a3: sign */ SYM_FUNC_START(unaligned_read) beqz a2, 5f li.w t2, 0 addi.d t0, a2, -1 slli.d t1, t0, 3 add.d a0, a0, t0 beqz a3, 2f 1: ld.b t3, a0, 0 b 3f 2: ld.bu t3, a0, 0 3: sll.d t3, t3, t1 or t2, t2, t3 addi.d t1, t1, -8 addi.d a0, a0, -1 addi.d a2, a2, -1 bgtz a2, 2b 4: st.d t2, a1, 0 move a0, a2 jr ra 5: li.w a0, -EFAULT jr ra _asm_extable 1b, .L_fixup_handle_unaligned _asm_extable 2b, .L_fixup_handle_unaligned _asm_extable 4b, .L_fixup_handle_unaligned SYM_FUNC_END(unaligned_read) /* * unsigned long unaligned_write(void *addr, unsigned long value, unsigned long n) * * a0: addr * a1: value * a2: n */ SYM_FUNC_START(unaligned_write) beqz a2, 3f li.w t0, 0 1: srl.d t1, a1, t0 2: st.b t1, a0, 0 addi.d t0, t0, 8 addi.d a2, a2, -1 addi.d a0, a0, 1 bgtz a2, 1b move a0, a2 jr ra 3: li.w a0, -EFAULT jr ra _asm_extable 2b, .L_fixup_handle_unaligned SYM_FUNC_END(unaligned_write) |