[linux-2.6-block.git] / arch / m68k / include / asm / math-emu.h

/* SPDX-License-Identifier: GPL-2.0 */
#ifndef _ASM_M68K_SETUP_H
#define _ASM_M68K_SETUP_H

#include <asm/setup.h>
#include <linux/linkage.h>

/* Status Register bits */

/* accrued exception bits */
#define FPSR_AEXC_INEX	3
#define FPSR_AEXC_DZ	4
#define FPSR_AEXC_UNFL	5
#define FPSR_AEXC_OVFL	6
#define FPSR_AEXC_IOP	7

/* exception status bits */
#define FPSR_EXC_INEX1	8
#define FPSR_EXC_INEX2	9
#define FPSR_EXC_DZ	10
#define FPSR_EXC_UNFL	11
#define FPSR_EXC_OVFL	12
#define FPSR_EXC_OPERR	13
#define FPSR_EXC_SNAN	14
#define FPSR_EXC_BSUN	15

/* quotient byte, assumes big-endian, of course */
#define FPSR_QUOTIENT(fpsr) (*((signed char *) &(fpsr) + 1))

/* condition code bits */
#define FPSR_CC_NAN	24
#define FPSR_CC_INF	25
#define FPSR_CC_Z	26
#define FPSR_CC_NEG	27


/* Control register bits */

/* rounding mode */
#define	FPCR_ROUND_RN	0		/* round to nearest/even */
#define FPCR_ROUND_RZ	1		/* round to zero */
#define FPCR_ROUND_RM	2		/* minus infinity */
#define FPCR_ROUND_RP	3		/* plus infinity */

/* rounding precision */
#define FPCR_PRECISION_X	0	/* long double */
#define FPCR_PRECISION_S	1	/* double */
#define FPCR_PRECISION_D	2	/* float */


/* Flags to select the debugging output */
#define PDECODE		0
#define PEXECUTE	1
#define PCONV		2
#define PNORM		3
#define PREGISTER	4
#define PINSTR		5
#define PUNIMPL		6
#define PMOVEM		7

#define PMDECODE	(1<<PDECODE)
#define PMEXECUTE	(1<<PEXECUTE)
#define PMCONV		(1<<PCONV)
#define PMNORM		(1<<PNORM)
#define PMREGISTER	(1<<PREGISTER)
#define PMINSTR		(1<<PINSTR)
#define PMUNIMPL	(1<<PUNIMPL)
#define PMMOVEM		(1<<PMOVEM)

#ifndef __ASSEMBLY__

#include <linux/kernel.h>
#include <linux/sched.h>

union fp_mant64 {
	unsigned long long m64;
	unsigned long m32[2];
};

union fp_mant128 {
	unsigned long long m64[2];
	unsigned long m32[4];
};

/* internal representation of extended fp numbers */
struct fp_ext {
	unsigned char lowmant;
	unsigned char sign;
	unsigned short exp;
	union fp_mant64 mant;
};

/* C representation of FPU registers */
/* NOTE: if you change this, you have to change the assembler offsets
   below and the size in <asm/fpu.h>, too */
struct fp_data {
	struct fp_ext fpreg[8];
	unsigned int fpcr;
	unsigned int fpsr;
	unsigned int fpiar;
	unsigned short prec;
	unsigned short rnd;
	struct fp_ext temp[2];
};

#ifdef FPU_EMU_DEBUG
extern unsigned int fp_debugprint;

#define dprint(bit, fmt, ...) ({			\
	if (fp_debugprint & (1 << (bit)))		\
		pr_info(fmt, ##__VA_ARGS__);		\
})
#else
#define dprint(bit, fmt, ...)	no_printk(fmt, ##__VA_ARGS__)
#endif

#define uprint(str) ({					\
	static int __count = 3;				\
							\
	if (__count > 0) {				\
		pr_err("You just hit an unimplemented "	\
		       "fpu instruction (%s)\n", str);	\
		pr_err("Please report this to ....\n");	\
		__count--;				\
	}						\
})

#define FPDATA		((struct fp_data *)current->thread.fp)

#else	/* __ASSEMBLY__ */

#define FPDATA		%a2

/* offsets from the base register to the floating point data in the task struct */
#define FPD_FPREG	(TASK_THREAD+THREAD_FPREG+0)
#define FPD_FPCR	(TASK_THREAD+THREAD_FPREG+96)
#define FPD_FPSR	(TASK_THREAD+THREAD_FPREG+100)
#define FPD_FPIAR	(TASK_THREAD+THREAD_FPREG+104)
#define FPD_PREC	(TASK_THREAD+THREAD_FPREG+108)
#define FPD_RND		(TASK_THREAD+THREAD_FPREG+110)
#define FPD_TEMPFP1	(TASK_THREAD+THREAD_FPREG+112)
#define FPD_TEMPFP2	(TASK_THREAD+THREAD_FPREG+124)
#define FPD_SIZEOF	(TASK_THREAD+THREAD_FPREG+136)

/* offsets on the stack to access saved registers,
 * these are only used during instruction decoding
 * where we always know how deep we're on the stack.
 */
#define FPS_DO		(PT_OFF_D0)
#define FPS_D1		(PT_OFF_D1)
#define FPS_D2		(PT_OFF_D2)
#define FPS_A0		(PT_OFF_A0)
#define FPS_A1		(PT_OFF_A1)
#define FPS_A2		(PT_OFF_A2)
#define FPS_SR		(PT_OFF_SR)
#define FPS_PC		(PT_OFF_PC)
#define FPS_EA		(PT_OFF_PC+6)
#define FPS_PC2		(PT_OFF_PC+10)

.macro	fp_get_fp_reg
	lea	(FPD_FPREG,FPDATA,%d0.w*4),%a0
	lea	(%a0,%d0.w*8),%a0
.endm

/* Macros used to get/put the current program counter.
 * 020/030 use a different stack frame then 040/060, for the
 * 040/060 the return pc points already to the next location,
 * so this only needs to be modified for jump instructions.
 */
.macro	fp_get_pc dest
	move.l	(FPS_PC+4,%sp),\dest
.endm

.macro	fp_put_pc src,jump=0
	move.l	\src,(FPS_PC+4,%sp)
.endm

.macro	fp_get_instr_data	f,s,dest,label
	getuser	\f,%sp@(FPS_PC+4)@(0),\dest,\label,%sp@(FPS_PC+4)
	addq.l	#\s,%sp@(FPS_PC+4)
.endm

.macro	fp_get_instr_word	dest,label,addr
	fp_get_instr_data	w,2,\dest,\label,\addr
.endm

.macro	fp_get_instr_long	dest,label,addr
	fp_get_instr_data	l,4,\dest,\label,\addr
.endm

/* These macros are used to read from/write to user space
 * on error we jump to the fixup section, load the fault
 * address into %a0 and jump to the exit.
 * (derived from <asm/uaccess.h>)
 */
.macro	getuser	size,src,dest,label,addr
|	printf	,"[\size<%08x]",1,\addr
.Lu1\@:	moves\size	\src,\dest

	.section .fixup,"ax"
	.even
.Lu2\@:	move.l	\addr,%a0
	jra	\label
	.previous

	.section __ex_table,"a"
	.align	4
	.long	.Lu1\@,.Lu2\@
	.previous
.endm

.macro	putuser	size,src,dest,label,addr
|	printf	,"[\size>%08x]",1,\addr
.Lu1\@:	moves\size	\src,\dest
.Lu2\@:

	.section .fixup,"ax"
	.even
.Lu3\@:	move.l	\addr,%a0
	jra	\label
	.previous

	.section __ex_table,"a"
	.align	4
	.long	.Lu1\@,.Lu3\@
	.long	.Lu2\@,.Lu3\@
	.previous
.endm

/* work around binutils idiocy */
old_gas=-1
.irp    gas_ident.x .x
old_gas=old_gas+1
.endr
.if !old_gas
.irp	m b,w,l
.macro	getuser.\m src,dest,label,addr
	getuser .\m,\src,\dest,\label,\addr
.endm
.macro	putuser.\m src,dest,label,addr
	putuser .\m,\src,\dest,\label,\addr
.endm
.endr
.endif

.macro	movestack	nr,arg1,arg2,arg3,arg4,arg5
	.if	\nr
	movestack	(\nr-1),\arg2,\arg3,\arg4,\arg5
	move.l	\arg1,-(%sp)
	.endif
.endm

.macro	printf	bit=-1,string,nr=0,arg1,arg2,arg3,arg4,arg5
#ifdef FPU_EMU_DEBUG
	.data
.Lpdata\@:
	.string	"\string"
	.previous

	movem.l	%d0/%d1/%a0/%a1,-(%sp)
	.if	\bit+1
#if 0
	moveq	#\bit,%d0
	andw	#7,%d0
	btst	%d0,fp_debugprint+((31-\bit)/8)
#else
	btst	#\bit,fp_debugprint+((31-\bit)/8)
#endif
	jeq	.Lpskip\@
	.endif
	movestack	\nr,\arg1,\arg2,\arg3,\arg4,\arg5
	pea	.Lpdata\@
	jsr	printk
	lea	((\nr+1)*4,%sp),%sp
.Lpskip\@:
	movem.l	(%sp)+,%d0/%d1/%a0/%a1
#endif
.endm

.macro	printx	bit,fp
#ifdef FPU_EMU_DEBUG
	movem.l	%d0/%a0,-(%sp)
	lea	\fp,%a0
#if 0
	moveq	#'+',%d0
	tst.w	(%a0)
	jeq	.Lx1\@
	moveq	#'-',%d0
.Lx1\@:	printf	\bit," %c",1,%d0
	move.l	(4,%a0),%d0
	bclr	#31,%d0
	jne	.Lx2\@
	printf	\bit,"0."
	jra	.Lx3\@
.Lx2\@:	printf	\bit,"1."
.Lx3\@:	printf	\bit,"%08x%08x",2,%d0,%a0@(8)
	move.w	(2,%a0),%d0
	ext.l	%d0
	printf	\bit,"E%04x",1,%d0
#else
	printf	\bit," %08x%08x%08x",3,%a0@,%a0@(4),%a0@(8)
#endif
	movem.l	(%sp)+,%d0/%a0
#endif
.endm

.macro	debug	instr,args
#ifdef FPU_EMU_DEBUG
	\instr	\args
#endif
.endm


#endif	/* __ASSEMBLY__ */

#endif	/* _ASM_M68K_SETUP_H */
Commit	Line	Data
b2441318	1	/* SPDX-License-Identifier: GPL-2.0 */
1da177e4 LT	2	#ifndef _ASM_M68K_SETUP_H
	3	#define _ASM_M68K_SETUP_H
	4
	5	#include <asm/setup.h>
	6	#include <linux/linkage.h>
	7
	8	/* Status Register bits */
	9
	10	/* accrued exception bits */
	11	#define FPSR_AEXC_INEX 3
	12	#define FPSR_AEXC_DZ 4
	13	#define FPSR_AEXC_UNFL 5
	14	#define FPSR_AEXC_OVFL 6
	15	#define FPSR_AEXC_IOP 7
	16
	17	/* exception status bits */
	18	#define FPSR_EXC_INEX1 8
	19	#define FPSR_EXC_INEX2 9
	20	#define FPSR_EXC_DZ 10
	21	#define FPSR_EXC_UNFL 11
	22	#define FPSR_EXC_OVFL 12
	23	#define FPSR_EXC_OPERR 13
	24	#define FPSR_EXC_SNAN 14
	25	#define FPSR_EXC_BSUN 15
	26
	27	/* quotient byte, assumes big-endian, of course */
	28	#define FPSR_QUOTIENT(fpsr) (((signed char ) &(fpsr) + 1))
	29
	30	/* condition code bits */
	31	#define FPSR_CC_NAN 24
	32	#define FPSR_CC_INF 25
	33	#define FPSR_CC_Z 26
	34	#define FPSR_CC_NEG 27
	35
	36
	37	/* Control register bits */
	38
	39	/* rounding mode */
	40	#define FPCR_ROUND_RN 0 /* round to nearest/even */
	41	#define FPCR_ROUND_RZ 1 /* round to zero */
	42	#define FPCR_ROUND_RM 2 /* minus infinity */
	43	#define FPCR_ROUND_RP 3 /* plus infinity */
	44
	45	/* rounding precision */
	46	#define FPCR_PRECISION_X 0 /* long double */
	47	#define FPCR_PRECISION_S 1 /* double */
	48	#define FPCR_PRECISION_D 2 /* float */
	49
	50
	51	/* Flags to select the debugging output */
	52	#define PDECODE 0
	53	#define PEXECUTE 1
	54	#define PCONV 2
	55	#define PNORM 3
	56	#define PREGISTER 4
	57	#define PINSTR 5
	58	#define PUNIMPL 6
	59	#define PMOVEM 7
	60
	61	#define PMDECODE (1<<PDECODE)
	62	#define PMEXECUTE (1<<PEXECUTE)
	63	#define PMCONV (1<<PCONV)
	64	#define PMNORM (1<<PNORM)
	65	#define PMREGISTER (1<<PREGISTER)
66	#define PMINSTR (1<<PINSTR)
67	#define PMUNIMPL (1<<PUNIMPL)
68	#define PMMOVEM (1<<PMOVEM)
69
70	#ifndef __ASSEMBLY__
71
72	#include <linux/kernel.h>
73	#include <linux/sched.h>
74
75	union fp_mant64 {
76	unsigned long long m64;
77	unsigned long m32[2];
78	};
79
80	union fp_mant128 {
81	unsigned long long m64[2];
82	unsigned long m32[4];
83	};
84
85	/* internal representation of extended fp numbers */
86	struct fp_ext {
87	unsigned char lowmant;
88	unsigned char sign;
89	unsigned short exp;
90	union fp_mant64 mant;
91	};
92
93	/* C representation of FPU registers */
94	/* NOTE: if you change this, you have to change the assembler offsets
95	below and the size in <asm/fpu.h>, too */
96	struct fp_data {
97	struct fp_ext fpreg[8];
98	unsigned int fpcr;
99	unsigned int fpsr;
100	unsigned int fpiar;
101	unsigned short prec;
102	unsigned short rnd;
103	struct fp_ext temp[2];
104	};
105
106	#ifdef FPU_EMU_DEBUG
107	extern unsigned int fp_debugprint;
108
f0b914ae	109	#define dprint(bit, fmt, ...) ({ \
1da177e4	110	if (fp_debugprint & (1 << (bit))) \
f0b914ae	111	pr_info(fmt, ##__VA_ARGS__); \
1da177e4 LT	112	})
1da177e4 LT	113	#else
f0b914ae	114	#define dprint(bit, fmt, ...) no_printk(fmt, ##__VA_ARGS__)
1da177e4 LT	115	#endif
	116
	117	#define uprint(str) ({ \
	118	static int __count = 3; \
	119	\
	120	if (__count > 0) { \
f0b914ae	121	pr_err("You just hit an unimplemented " \
1da177e4	122	"fpu instruction (%s)\n", str); \
f0b914ae	123	pr_err("Please report this to ....\n"); \
1da177e4 LT	124	__count--; \
	125	} \
	126	})
	127
	128	#define FPDATA ((struct fp_data *)current->thread.fp)
	129
	130	#else /* __ASSEMBLY__ */
	131
	132	#define FPDATA %a2
	133
	134	/* offsets from the base register to the floating point data in the task struct */
	135	#define FPD_FPREG (TASK_THREAD+THREAD_FPREG+0)
	136	#define FPD_FPCR (TASK_THREAD+THREAD_FPREG+96)
	137	#define FPD_FPSR (TASK_THREAD+THREAD_FPREG+100)
	138	#define FPD_FPIAR (TASK_THREAD+THREAD_FPREG+104)
	139	#define FPD_PREC (TASK_THREAD+THREAD_FPREG+108)
	140	#define FPD_RND (TASK_THREAD+THREAD_FPREG+110)
	141	#define FPD_TEMPFP1 (TASK_THREAD+THREAD_FPREG+112)
	142	#define FPD_TEMPFP2 (TASK_THREAD+THREAD_FPREG+124)
	143	#define FPD_SIZEOF (TASK_THREAD+THREAD_FPREG+136)
	144
	145	/* offsets on the stack to access saved registers,
	146	* these are only used during instruction decoding
	147	* where we always know how deep we're on the stack.
	148	*/
f159ee78 HC	149	#define FPS_DO (PT_OFF_D0)
	150	#define FPS_D1 (PT_OFF_D1)
	151	#define FPS_D2 (PT_OFF_D2)
	152	#define FPS_A0 (PT_OFF_A0)
	153	#define FPS_A1 (PT_OFF_A1)
	154	#define FPS_A2 (PT_OFF_A2)
	155	#define FPS_SR (PT_OFF_SR)
	156	#define FPS_PC (PT_OFF_PC)
	157	#define FPS_EA (PT_OFF_PC+6)
	158	#define FPS_PC2 (PT_OFF_PC+10)
1da177e4 LT	159
	160	.macro fp_get_fp_reg
	161	lea (FPD_FPREG,FPDATA,%d0.w*4),%a0
	162	lea (%a0,%d0.w*8),%a0
	163	.endm
	164
	165	/* Macros used to get/put the current program counter.
	166	* 020/030 use a different stack frame then 040/060, for the
	167	* 040/060 the return pc points already to the next location,
	168	* so this only needs to be modified for jump instructions.
	169	*/
	170	.macro fp_get_pc dest
	171	move.l (FPS_PC+4,%sp),\dest
	172	.endm
	173
	174	.macro fp_put_pc src,jump=0
	175	move.l \src,(FPS_PC+4,%sp)
	176	.endm
	177
	178	.macro fp_get_instr_data f,s,dest,label
	179	getuser \f,%sp@(FPS_PC+4)@(0),\dest,\label,%sp@(FPS_PC+4)
	180	addq.l #\s,%sp@(FPS_PC+4)
	181	.endm
	182
	183	.macro fp_get_instr_word dest,label,addr
	184	fp_get_instr_data w,2,\dest,\label,\addr
	185	.endm
	186
	187	.macro fp_get_instr_long dest,label,addr
	188	fp_get_instr_data l,4,\dest,\label,\addr
	189	.endm
	190
	191	/* These macros are used to read from/write to user space
	192	* on error we jump to the fixup section, load the fault
	193	* address into %a0 and jump to the exit.
	194	* (derived from <asm/uaccess.h>)
	195	*/
	196	.macro getuser size,src,dest,label,addr
	197	\| printf ,"[\size<%08x]",1,\addr
	198	.Lu1\@: moves\size \src,\dest
	199
	200	.section .fixup,"ax"
	201	.even
	202	.Lu2\@: move.l \addr,%a0
	203	jra \label
	204	.previous
	205
	206	.section __ex_table,"a"
	207	.align 4
	208	.long .Lu1\@,.Lu2\@
	209	.previous
	210	.endm
	211
	212	.macro putuser size,src,dest,label,addr
	213	\| printf ,"[\size>%08x]",1,\addr
	214	.Lu1\@: moves\size \src,\dest
	215	.Lu2\@:
	216
	217	.section .fixup,"ax"
	218	.even
	219	.Lu3\@: move.l \addr,%a0
	220	jra \label
	221	.previous
	222
223	.section __ex_table,"a"
224	.align 4
225	.long .Lu1\@,.Lu3\@
226	.long .Lu2\@,.Lu3\@
227	.previous
228	.endm
229
38135614 AV	230	/* work around binutils idiocy */
	231	old_gas=-1
	232	.irp gas_ident.x .x
	233	old_gas=old_gas+1
	234	.endr
	235	.if !old_gas
	236	.irp m b,w,l
	237	.macro getuser.\m src,dest,label,addr
	238	getuser .\m,\src,\dest,\label,\addr
	239	.endm
	240	.macro putuser.\m src,dest,label,addr
	241	putuser .\m,\src,\dest,\label,\addr
	242	.endm
	243	.endr
	244	.endif
1da177e4 LT	245
	246	.macro movestack nr,arg1,arg2,arg3,arg4,arg5
	247	.if \nr
	248	movestack (\nr-1),\arg2,\arg3,\arg4,\arg5
	249	move.l \arg1,-(%sp)
	250	.endif
	251	.endm
	252
	253	.macro printf bit=-1,string,nr=0,arg1,arg2,arg3,arg4,arg5
	254	#ifdef FPU_EMU_DEBUG
	255	.data
	256	.Lpdata\@:
	257	.string "\string"
	258	.previous
	259
	260	movem.l %d0/%d1/%a0/%a1,-(%sp)
	261	.if \bit+1
	262	#if 0
	263	moveq #\bit,%d0
	264	andw #7,%d0
	265	btst %d0,fp_debugprint+((31-\bit)/8)
	266	#else
	267	btst #\bit,fp_debugprint+((31-\bit)/8)
	268	#endif
	269	jeq .Lpskip\@
	270	.endif
	271	movestack \nr,\arg1,\arg2,\arg3,\arg4,\arg5
	272	pea .Lpdata\@
	273	jsr printk
	274	lea ((\nr+1)*4,%sp),%sp
	275	.Lpskip\@:
	276	movem.l (%sp)+,%d0/%d1/%a0/%a1
	277	#endif
	278	.endm
	279
	280	.macro printx bit,fp
	281	#ifdef FPU_EMU_DEBUG
	282	movem.l %d0/%a0,-(%sp)
	283	lea \fp,%a0
	284	#if 0
	285	moveq #'+',%d0
	286	tst.w (%a0)
	287	jeq .Lx1\@
	288	moveq #'-',%d0
	289	.Lx1\@: printf \bit," %c",1,%d0
	290	move.l (4,%a0),%d0
	291	bclr #31,%d0
	292	jne .Lx2\@
	293	printf \bit,"0."
	294	jra .Lx3\@
	295	.Lx2\@: printf \bit,"1."
	296	.Lx3\@: printf \bit,"%08x%08x",2,%d0,%a0@(8)
	297	move.w (2,%a0),%d0
	298	ext.l %d0
	299	printf \bit,"E%04x",1,%d0
	300	#else
	301	printf \bit," %08x%08x%08x",3,%a0@,%a0@(4),%a0@(8)
	302	#endif
	303	movem.l (%sp)+,%d0/%a0
	304	#endif
	305	.endm
	306
	307	.macro debug instr,args
	308	#ifdef FPU_EMU_DEBUG
309	\instr \args
310	#endif
311	.endm
312
313
314	#endif /* __ASSEMBLY__ */
315
316	#endif /* _ASM_M68K_SETUP_H */