| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /*---------------------------------------------------------------------------+ | 
 | 2 |  |  fpu_arith.c                                                              | | 
 | 3 |  |                                                                           | | 
 | 4 |  | Code to implement the FPU register/register arithmetic instructions       | | 
 | 5 |  |                                                                           | | 
 | 6 |  | Copyright (C) 1992,1993,1997                                              | | 
 | 7 |  |                  W. Metzenthen, 22 Parker St, Ormond, Vic 3163, Australia | | 
 | 8 |  |                  E-mail   billm@suburbia.net                              | | 
 | 9 |  |                                                                           | | 
 | 10 |  |                                                                           | | 
 | 11 |  +---------------------------------------------------------------------------*/ | 
 | 12 |  | 
 | 13 | #include "fpu_system.h" | 
 | 14 | #include "fpu_emu.h" | 
 | 15 | #include "control_w.h" | 
 | 16 | #include "status_w.h" | 
 | 17 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 18 | void fadd__(void) | 
 | 19 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 20 | 	/* fadd st,st(i) */ | 
 | 21 | 	int i = FPU_rm; | 
 | 22 | 	clear_C1(); | 
 | 23 | 	FPU_add(&st(i), FPU_gettagi(i), 0, control_word); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 24 | } | 
 | 25 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 26 | void fmul__(void) | 
 | 27 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 28 | 	/* fmul st,st(i) */ | 
 | 29 | 	int i = FPU_rm; | 
 | 30 | 	clear_C1(); | 
 | 31 | 	FPU_mul(&st(i), FPU_gettagi(i), 0, control_word); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 32 | } | 
 | 33 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 | void fsub__(void) | 
 | 35 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 36 | 	/* fsub st,st(i) */ | 
 | 37 | 	clear_C1(); | 
 | 38 | 	FPU_sub(0, FPU_rm, control_word); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 | } | 
 | 40 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 | void fsubr_(void) | 
 | 42 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 43 | 	/* fsubr st,st(i) */ | 
 | 44 | 	clear_C1(); | 
 | 45 | 	FPU_sub(REV, FPU_rm, control_word); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 46 | } | 
 | 47 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | void fdiv__(void) | 
 | 49 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 50 | 	/* fdiv st,st(i) */ | 
 | 51 | 	clear_C1(); | 
 | 52 | 	FPU_div(0, FPU_rm, control_word); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | } | 
 | 54 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 55 | void fdivr_(void) | 
 | 56 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 57 | 	/* fdivr st,st(i) */ | 
 | 58 | 	clear_C1(); | 
 | 59 | 	FPU_div(REV, FPU_rm, control_word); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 60 | } | 
 | 61 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 62 | void fadd_i(void) | 
 | 63 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 64 | 	/* fadd st(i),st */ | 
 | 65 | 	int i = FPU_rm; | 
 | 66 | 	clear_C1(); | 
 | 67 | 	FPU_add(&st(i), FPU_gettagi(i), i, control_word); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 68 | } | 
 | 69 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 70 | void fmul_i(void) | 
 | 71 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 72 | 	/* fmul st(i),st */ | 
 | 73 | 	clear_C1(); | 
 | 74 | 	FPU_mul(&st(0), FPU_gettag0(), FPU_rm, control_word); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 75 | } | 
 | 76 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 77 | void fsubri(void) | 
 | 78 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 79 | 	/* fsubr st(i),st */ | 
 | 80 | 	clear_C1(); | 
 | 81 | 	FPU_sub(DEST_RM, FPU_rm, control_word); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 82 | } | 
 | 83 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 84 | void fsub_i(void) | 
 | 85 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 86 | 	/* fsub st(i),st */ | 
 | 87 | 	clear_C1(); | 
 | 88 | 	FPU_sub(REV | DEST_RM, FPU_rm, control_word); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 89 | } | 
 | 90 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 91 | void fdivri(void) | 
 | 92 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 93 | 	/* fdivr st(i),st */ | 
 | 94 | 	clear_C1(); | 
 | 95 | 	FPU_div(DEST_RM, FPU_rm, control_word); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 96 | } | 
 | 97 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 98 | void fdiv_i(void) | 
 | 99 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 100 | 	/* fdiv st(i),st */ | 
 | 101 | 	clear_C1(); | 
 | 102 | 	FPU_div(REV | DEST_RM, FPU_rm, control_word); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 103 | } | 
 | 104 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 105 | void faddp_(void) | 
 | 106 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 107 | 	/* faddp st(i),st */ | 
 | 108 | 	int i = FPU_rm; | 
 | 109 | 	clear_C1(); | 
 | 110 | 	if (FPU_add(&st(i), FPU_gettagi(i), i, control_word) >= 0) | 
 | 111 | 		FPU_pop(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 112 | } | 
 | 113 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 114 | void fmulp_(void) | 
 | 115 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 116 | 	/* fmulp st(i),st */ | 
 | 117 | 	clear_C1(); | 
 | 118 | 	if (FPU_mul(&st(0), FPU_gettag0(), FPU_rm, control_word) >= 0) | 
 | 119 | 		FPU_pop(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 120 | } | 
 | 121 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 122 | void fsubrp(void) | 
 | 123 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 124 | 	/* fsubrp st(i),st */ | 
 | 125 | 	clear_C1(); | 
 | 126 | 	if (FPU_sub(DEST_RM, FPU_rm, control_word) >= 0) | 
 | 127 | 		FPU_pop(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 128 | } | 
 | 129 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 130 | void fsubp_(void) | 
 | 131 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 132 | 	/* fsubp st(i),st */ | 
 | 133 | 	clear_C1(); | 
 | 134 | 	if (FPU_sub(REV | DEST_RM, FPU_rm, control_word) >= 0) | 
 | 135 | 		FPU_pop(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 136 | } | 
 | 137 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 138 | void fdivrp(void) | 
 | 139 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 140 | 	/* fdivrp st(i),st */ | 
 | 141 | 	clear_C1(); | 
 | 142 | 	if (FPU_div(DEST_RM, FPU_rm, control_word) >= 0) | 
 | 143 | 		FPU_pop(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 144 | } | 
 | 145 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 146 | void fdivp_(void) | 
 | 147 | { | 
| Ingo Molnar | 3d0d14f | 2008-01-30 13:30:11 +0100 | [diff] [blame] | 148 | 	/* fdivp st(i),st */ | 
 | 149 | 	clear_C1(); | 
 | 150 | 	if (FPU_div(REV | DEST_RM, FPU_rm, control_word) >= 0) | 
 | 151 | 		FPU_pop(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 152 | } |