/*
 *    ptrace cpu depend helper functions
 *
 *  Copyright 2003, 2015 Yoshinori Sato <ysato@users.sourceforge.jp>
 *
 * This file is subject to the terms and conditions of the GNU General
 * Public License.  See the file COPYING in the main directory of
 * this archive for more details.
 */

#include <linux/linkage.h>
#include <linux/sched.h>
#include <asm/ptrace.h>

#define BREAKINST 0x5730 /* trapa #3 */

/* disable singlestep */
void user_disable_single_step(struct task_struct *child)
{
	if ((long)child->thread.breakinfo.addr != -1L) {
		*(child->thread.breakinfo.addr) = child->thread.breakinfo.inst;
		child->thread.breakinfo.addr = (unsigned short *)-1L;
	}
}

/* calculate next pc */
enum jump_type {none,	 /* normal instruction */
		jabs,	 /* absolute address jump */
		ind,	 /* indirect address jump */
		ret,	 /* return to subrutine */
		reg,	 /* register indexed jump */
		relb,	 /* pc relative jump (byte offset) */
		relw,	 /* pc relative jump (word offset) */
	       };

/* opcode decode table define
   ptn: opcode pattern
   msk: opcode bitmask
   len: instruction length (<0 next table index)
   jmp: jump operation mode */
struct optable {
	unsigned char bitpattern;
	unsigned char bitmask;
	signed char length;
	signed char type;
} __packed __aligned(1);

#define OPTABLE(ptn, msk, len, jmp)	\
	{				\
		.bitpattern = ptn,	\
		.bitmask    = msk,	\
		.length	    = len,	\
		.type	    = jmp,	\
	}

static const struct optable optable_0[] = {
	OPTABLE(0x00, 0xff,  1, none), /* 0x00 */
	OPTABLE(0x01, 0xff, -1, none), /* 0x01 */
	OPTABLE(0x02, 0xfe,  1, none), /* 0x02-0x03 */
	OPTABLE(0x04, 0xee,  1, none), /* 0x04-0x05/0x14-0x15 */
	OPTABLE(0x06, 0xfe,  1, none), /* 0x06-0x07 */
	OPTABLE(0x08, 0xea,  1, none), /* 0x08-0x09/0x0c-0x0d/0x18-0x19/0x1c-0x1d */
	OPTABLE(0x0a, 0xee,  1, none), /* 0x0a-0x0b/0x1a-0x1b */
	OPTABLE(0x0e, 0xee,  1, none), /* 0x0e-0x0f/0x1e-0x1f */
	OPTABLE(0x10, 0xfc,  1, none), /* 0x10-0x13 */
	OPTABLE(0x16, 0xfe,  1, none), /* 0x16-0x17 */
	OPTABLE(0x20, 0xe0,  1, none), /* 0x20-0x3f */
	OPTABLE(0x40, 0xf0,  1, relb), /* 0x40-0x4f */
	OPTABLE(0x50, 0xfc,  1, none), /* 0x50-0x53 */
	OPTABLE(0x54, 0xfd,  1, ret), /* 0x54/0x56 */
	OPTABLE(0x55, 0xff,  1, relb), /* 0x55 */
	OPTABLE(0x57, 0xff,  1, none), /* 0x57 */
	OPTABLE(0x58, 0xfb,  2, relw), /* 0x58/0x5c */
	OPTABLE(0x59, 0xfb,  1, reg), /* 0x59/0x5b */
	OPTABLE(0x5a, 0xfb,  2, jabs), /* 0x5a/0x5e */
	OPTABLE(0x5b, 0xfb,  2, ind), /* 0x5b/0x5f */
	OPTABLE(0x60, 0xe8,  1, none), /* 0x60-0x67/0x70-0x77 */
	OPTABLE(0x68, 0xfa,  1, none), /* 0x68-0x69/0x6c-0x6d */
	OPTABLE(0x6a, 0xfe, -2, none), /* 0x6a-0x6b */
	OPTABLE(0x6e, 0xfe,  2, none), /* 0x6e-0x6f */
	OPTABLE(0x78, 0xff,  4, none), /* 0x78 */
	OPTABLE(0x79, 0xff,  2, none), /* 0x79 */
	OPTABLE(0x7a, 0xff,  3, none), /* 0x7a */
	OPTABLE(0x7b, 0xff,  2, none), /* 0x7b */
	OPTABLE(0x7c, 0xfc,  2, none), /* 0x7c-0x7f */
	OPTABLE(0x80, 0x80,  1, none), /* 0x80-0xff */
};

static const struct optable optable_1[] = {
	OPTABLE(0x00, 0xff, -3, none), /* 0x0100 */
	OPTABLE(0x40, 0xf0, -3, none), /* 0x0140-0x14f */
	OPTABLE(0x80, 0xf0,  1, none), /* 0x0180-0x018f */
	OPTABLE(0xc0, 0xc0,  2, none), /* 0x01c0-0x01ff */
};

static const struct optable optable_2[] = {
	OPTABLE(0x00, 0x20,  2, none), /* 0x6a0?/0x6a8?/0x6b0?/0x6b8? */
	OPTABLE(0x20, 0x20,  3, none), /* 0x6a2?/0x6aa?/0x6b2?/0x6ba? */
};

static const struct optable optable_3[] = {
	OPTABLE(0x69, 0xfb,  2, none), /* 0x010069/0x01006d/014069/0x01406d */
	OPTABLE(0x6b, 0xff, -4, none), /* 0x01006b/0x01406b */
	OPTABLE(0x6f, 0xff,  3, none), /* 0x01006f/0x01406f */
	OPTABLE(0x78, 0xff,  5, none), /* 0x010078/0x014078 */
};

static const struct optable optable_4[] = {
/* 0x0100690?/0x01006d0?/0140690?/0x01406d0?/
   0x0100698?/0x01006d8?/0140698?/0x01406d8? */
	OPTABLE(0x00, 0x78, 3, none),
/* 0x0100692?/0x01006d2?/0140692?/0x01406d2?/
   0x010069a?/0x01006da?/014069a?/0x01406da? */
	OPTABLE(0x20, 0x78, 4, none),
};

static const struct optables_list {
	const struct optable *ptr;
	int size;
} optables[] = {
#define OPTABLES(no)                                                   \
	{                                                              \
		.ptr  = optable_##no,                                  \
		.size = sizeof(optable_##no) / sizeof(struct optable), \
	}
	OPTABLES(0),
	OPTABLES(1),
	OPTABLES(2),
	OPTABLES(3),
	OPTABLES(4),

};

const unsigned char condmask[] = {
	0x00, 0x40, 0x01, 0x04, 0x02, 0x08, 0x10, 0x20
};

static int isbranch(struct task_struct *task, int reson)
{
	unsigned char cond = h8300_get_reg(task, PT_CCR);

	/* encode complex conditions */
	/* B4: N^V
	   B5: Z|(N^V)
	   B6: C|Z */
	__asm__("bld #3,%w0\n\t"
		"bxor #1,%w0\n\t"
		"bst #4,%w0\n\t"
		"bor #2,%w0\n\t"
		"bst #5,%w0\n\t"
		"bld #2,%w0\n\t"
		"bor #0,%w0\n\t"
		"bst #6,%w0\n\t"
		: "=&r"(cond) : "0"(cond) : "cc");
	cond &= condmask[reson >> 1];
	if (!(reson & 1))
		return cond == 0;
	else
		return cond != 0;
}

static unsigned short *decode(struct task_struct *child,
			      const struct optable *op,
			      char *fetch_p, unsigned short *pc,
			      unsigned char inst)
{
	unsigned long addr;
	unsigned long *sp;
	int regno;

	switch (op->type) {
	case none:
		return (unsigned short *)pc + op->length;
	case jabs:
		addr = *(unsigned long *)pc;
		return (unsigned short *)(addr & 0x00ffffff);
	case ind:
		addr = *pc & 0xff;
		return (unsigned short *)(*(unsigned long *)addr);
	case ret:
		sp = (unsigned long *)h8300_get_reg(child, PT_USP);
		/* user stack frames
		   |   er0  | temporary saved
		   +--------+
		   |   exp  | exception stack frames
		   +--------+
		   | ret pc | userspace return address
		*/
		return (unsigned short *)(*(sp+2) & 0x00ffffff);
	case reg:
		regno = (*pc >> 4) & 0x07;
		if (regno == 0)
			addr = h8300_get_reg(child, PT_ER0);
		else
			addr = h8300_get_reg(child, regno-1 + PT_ER1);
		return (unsigned short *)addr;
	case relb:
		if (inst == 0x55 || isbranch(child, inst & 0x0f))
			pc = (unsigned short *)((unsigned long)pc +
						((signed char)(*fetch_p)));
		return pc+1; /* skip myself */
	case relw:
		if (inst == 0x5c || isbranch(child, (*fetch_p & 0xf0) >> 4))
			pc = (unsigned short *)((unsigned long)pc +
						((signed short)(*(pc+1))));
		return pc+2; /* skip myself */
	default:
		return NULL;
	}
}

static unsigned short *nextpc(struct task_struct *child, unsigned short *pc)
{
	const struct optable *op;
	unsigned char *fetch_p;
	int op_len;
	unsigned char inst;

	op = optables[0].ptr;
	op_len = optables[0].size;
	fetch_p = (unsigned char *)pc;
	inst = *fetch_p++;
	do {
		if ((inst & op->bitmask) == op->bitpattern) {
			if (op->length < 0) {
				op = optables[-op->length].ptr;
				op_len = optables[-op->length].size + 1;
				inst = *fetch_p++;
			} else
				return decode(child, op, fetch_p, pc, inst);
		} else
			op++;
	} while (--op_len > 0);
	return NULL;
}

/* Set breakpoint(s) to simulate a single step from the current PC.  */

void user_enable_single_step(struct task_struct *child)
{
	unsigned short *next;

	next = nextpc(child, (unsigned short *)h8300_get_reg(child, PT_PC));
	child->thread.breakinfo.addr = next;
	child->thread.breakinfo.inst = *next;
	*next = BREAKINST;
}

asmlinkage void trace_trap(unsigned long bp)
{
	if ((unsigned long)current->thread.breakinfo.addr == bp) {
		user_disable_single_step(current);
		force_sig(SIGTRAP, current);
	} else
		force_sig(SIGILL, current);
}