18c2ecf20Sopenharmony_ci/* SPDX-License-Identifier: GPL-2.0 */ 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Copyright (C) 2020-2022 Loongson Technology Corporation Limited 48c2ecf20Sopenharmony_ci */ 58c2ecf20Sopenharmony_ci 68c2ecf20Sopenharmony_ci#include <linux/linkage.h> 78c2ecf20Sopenharmony_ci 88c2ecf20Sopenharmony_ci#include <asm/asm.h> 98c2ecf20Sopenharmony_ci#include <asm/asmmacro.h> 108c2ecf20Sopenharmony_ci#include <asm/asm-extable.h> 118c2ecf20Sopenharmony_ci#include <asm/errno.h> 128c2ecf20Sopenharmony_ci#include <asm/export.h> 138c2ecf20Sopenharmony_ci#include <asm/regdef.h> 148c2ecf20Sopenharmony_ci 158c2ecf20Sopenharmony_ci.L_fixup_handle_unaligned: 168c2ecf20Sopenharmony_ci li.w a0, -EFAULT 178c2ecf20Sopenharmony_ci jr ra 188c2ecf20Sopenharmony_ci 198c2ecf20Sopenharmony_ci/* 208c2ecf20Sopenharmony_ci * unsigned long unaligned_read(void *addr, void *value, unsigned long n, bool sign) 218c2ecf20Sopenharmony_ci * 228c2ecf20Sopenharmony_ci * a0: addr 238c2ecf20Sopenharmony_ci * a1: value 248c2ecf20Sopenharmony_ci * a2: n 258c2ecf20Sopenharmony_ci * a3: sign 268c2ecf20Sopenharmony_ci */ 278c2ecf20Sopenharmony_ciSYM_FUNC_START(unaligned_read) 288c2ecf20Sopenharmony_ci beqz a2, 5f 298c2ecf20Sopenharmony_ci 308c2ecf20Sopenharmony_ci li.w t2, 0 318c2ecf20Sopenharmony_ci addi.d t0, a2, -1 328c2ecf20Sopenharmony_ci slli.d t1, t0, 3 338c2ecf20Sopenharmony_ci add.d a0, a0, t0 348c2ecf20Sopenharmony_ci 358c2ecf20Sopenharmony_ci beqz a3, 2f 368c2ecf20Sopenharmony_ci1: ld.b t3, a0, 0 378c2ecf20Sopenharmony_ci b 3f 388c2ecf20Sopenharmony_ci 398c2ecf20Sopenharmony_ci2: ld.bu t3, a0, 0 408c2ecf20Sopenharmony_ci3: sll.d t3, t3, t1 418c2ecf20Sopenharmony_ci or t2, t2, t3 428c2ecf20Sopenharmony_ci addi.d t1, t1, -8 438c2ecf20Sopenharmony_ci addi.d a0, a0, -1 448c2ecf20Sopenharmony_ci addi.d a2, a2, -1 458c2ecf20Sopenharmony_ci bgtz a2, 2b 468c2ecf20Sopenharmony_ci4: st.d t2, a1, 0 478c2ecf20Sopenharmony_ci 488c2ecf20Sopenharmony_ci move a0, a2 498c2ecf20Sopenharmony_ci jr ra 508c2ecf20Sopenharmony_ci 518c2ecf20Sopenharmony_ci5: li.w a0, -EFAULT 528c2ecf20Sopenharmony_ci jr ra 538c2ecf20Sopenharmony_ci 548c2ecf20Sopenharmony_ci _asm_extable 1b, .L_fixup_handle_unaligned 558c2ecf20Sopenharmony_ci _asm_extable 2b, .L_fixup_handle_unaligned 568c2ecf20Sopenharmony_ci _asm_extable 4b, .L_fixup_handle_unaligned 578c2ecf20Sopenharmony_ciSYM_FUNC_END(unaligned_read) 588c2ecf20Sopenharmony_ci 598c2ecf20Sopenharmony_ci/* 608c2ecf20Sopenharmony_ci * unsigned long unaligned_write(void *addr, unsigned long value, unsigned long n) 618c2ecf20Sopenharmony_ci * 628c2ecf20Sopenharmony_ci * a0: addr 638c2ecf20Sopenharmony_ci * a1: value 648c2ecf20Sopenharmony_ci * a2: n 658c2ecf20Sopenharmony_ci */ 668c2ecf20Sopenharmony_ciSYM_FUNC_START(unaligned_write) 678c2ecf20Sopenharmony_ci beqz a2, 3f 688c2ecf20Sopenharmony_ci 698c2ecf20Sopenharmony_ci li.w t0, 0 708c2ecf20Sopenharmony_ci1: srl.d t1, a1, t0 718c2ecf20Sopenharmony_ci2: st.b t1, a0, 0 728c2ecf20Sopenharmony_ci addi.d t0, t0, 8 738c2ecf20Sopenharmony_ci addi.d a2, a2, -1 748c2ecf20Sopenharmony_ci addi.d a0, a0, 1 758c2ecf20Sopenharmony_ci bgtz a2, 1b 768c2ecf20Sopenharmony_ci 778c2ecf20Sopenharmony_ci move a0, a2 788c2ecf20Sopenharmony_ci jr ra 798c2ecf20Sopenharmony_ci 808c2ecf20Sopenharmony_ci3: li.w a0, -EFAULT 818c2ecf20Sopenharmony_ci jr ra 828c2ecf20Sopenharmony_ci 838c2ecf20Sopenharmony_ci _asm_extable 2b, .L_fixup_handle_unaligned 848c2ecf20Sopenharmony_ciSYM_FUNC_END(unaligned_write) 85