arm/mm/alignment.c

327 do_alignment_finish_ldst(unsigned long addr, u32 instr, struct pt_regs *regs, union offset_union offset)
329 	if (!LDST_U_BIT(instr))
332 	if (!LDST_P_BIT(instr))
335 	if (!LDST_P_BIT(instr) || LDST_W_BIT(instr))
336 		regs->uregs[RN_BITS(instr)] = addr;
340 do_alignment_ldrhstrh(unsigned long addr, u32 instr, struct pt_regs *regs)
342 	unsigned int rd = RD_BITS(instr);
349 	if (LDST_L_BIT(instr)) {
354 		if (instr & 0x40)
364 	if (LDST_L_BIT(instr)) {
372 		if (instr & 0x40)
389 do_alignment_ldrdstrd(unsigned long addr, u32 instr, struct pt_regs *regs)
391 	unsigned int rd = RD_BITS(instr);
395 	if ((instr & 0xfe000000) == 0xe8000000) {
397 		rd2 = (instr >> 8) & 0xf;
398 		load = !!(LDST_L_BIT(instr));
402 		load = ((instr & 0xf0) == 0xd0);
451 do_alignment_ldrstr(unsigned long addr, u32 instr, struct pt_regs *regs)
453 	unsigned int rd = RD_BITS(instr);
457 	if ((!LDST_P_BIT(instr) && LDST_W_BIT(instr)) || user_mode(regs))
460 	if (LDST_L_BIT(instr)) {
469 	if (LDST_L_BIT(instr)) {
500 do_alignment_ldmstm(unsigned long addr, u32 instr, struct pt_regs *regs)
505 	if (LDM_S_BIT(instr))
514 	nr_regs = hweight16(REGMASK_BITS(instr)) * 4;
516 	rn = RN_BITS(instr);
519 	if (!LDST_U_BIT(instr))
522 	if (!LDST_U_BIT(instr))
525 	if (LDST_P_EQ_U(instr))	/* U = P */
541 		pr_err("LDMSTM: PC = %08lx, instr = %08x, "
543 			 instruction_pointer(regs), instr, addr, eaddr);
550 		for (regbits = REGMASK_BITS(instr), rd = 0; regbits;
553 				if (LDST_L_BIT(instr)) {
563 		for (regbits = REGMASK_BITS(instr), rd = 0; regbits;
566 				if (LDST_L_BIT(instr)) {
576 	if (LDST_W_BIT(instr))
578 	if (!LDST_L_BIT(instr) || !(REGMASK_BITS(instr) & (1 << 15)))
721 	u32 instr = *pinstr;
722 	u16 tinst1 = (instr >> 16) & 0xffff;
723 	u16 tinst2 = instr & 0xffff;
735 		if (RN_BITS(instr) == 13 && (tinst2 & 0x09ff) == 0x0904) {
736 			u32 L = !!(LDST_L_BIT(instr));
741 			*pinstr = subset[L] | (1<<RD_BITS(instr));
771 	u32 instr = 0;
775 		fault = get_user(instr, ip);
777 		fault = get_kernel_nofault(instr, ip);
779 	*inst = __mem_to_opcode_arm(instr);
786 	u16 instr = 0;
790 		fault = get_user(instr, ip);
792 		fault = get_kernel_nofault(instr, ip);
794 	*inst = __mem_to_opcode_thumb16(instr);
804 	int (*handler)(unsigned long addr, u32 instr, struct pt_regs *regs);
806 	u32 instr = 0;
827 				instr = __opcode_thumb32_compose(tinstr, tinst2);
831 				instr = thumb2arm(tinstr);
835 		fault = alignment_get_arm(regs, (void *)instrptr, &instr);
853 	switch (CODING_BITS(instr)) {
855 		if (LDSTHD_I_BIT(instr))
856 			offset.un = (instr & 0xf00) >> 4 | (instr & 15);
858 			offset.un = regs->uregs[RM_BITS(instr)];
860 		if ((instr & 0x000000f0) == 0x000000b0 || /* LDRH, STRH */
861 		    (instr & 0x001000f0) == 0x001000f0)   /* LDRSH */
863 		else if ((instr & 0x001000f0) == 0x000000d0 || /* LDRD */
864 			 (instr & 0x001000f0) == 0x000000f0)   /* STRD */
866 		else if ((instr & 0x01f00ff0) == 0x01000090) /* SWP */
873 		if (COND_BITS(instr) == 0xf0000000) /* NEON VLDn, VSTn */
875 		offset.un = OFFSET_BITS(instr);
880 		offset.un = regs->uregs[RM_BITS(instr)];
882 		if (IS_SHIFT(instr)) {
883 			unsigned int shiftval = SHIFT_BITS(instr);
885 			switch(SHIFT_TYPE(instr)) {
915 			handler = do_alignment_t32_to_handler(&instr, regs, &offset);
928 	type = handler(addr, instr, regs);
936 		do_alignment_finish_ldst(addr, instr, regs, offset);
962 		isize == 2 ? tinstr : instr, instrptr);
974 			isize == 2 ? tinstr : instr,