274 lines
		
	
	
		
			6.1 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			274 lines
		
	
	
		
			6.1 KiB
		
	
	
	
		
			C
		
	
	
	
/*
 | 
						|
    NetWinder Floating Point Emulator
 | 
						|
    (c) Rebel.COM, 1998,1999
 | 
						|
 | 
						|
    Direct questions, comments to Scott Bambrough <scottb@netwinder.org>
 | 
						|
 | 
						|
    This program is free software; you can redistribute it and/or modify
 | 
						|
    it under the terms of the GNU General Public License as published by
 | 
						|
    the Free Software Foundation; either version 2 of the License, or
 | 
						|
    (at your option) any later version.
 | 
						|
 | 
						|
    This program is distributed in the hope that it will be useful,
 | 
						|
    but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
						|
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | 
						|
    GNU General Public License for more details.
 | 
						|
 | 
						|
    You should have received a copy of the GNU General Public License
 | 
						|
    along with this program; if not, write to the Free Software
 | 
						|
    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 | 
						|
*/
 | 
						|
 | 
						|
#include "fpa11.h"
 | 
						|
#include "softfloat.h"
 | 
						|
#include "fpopcode.h"
 | 
						|
 | 
						|
floatx80 floatx80_exp(floatx80 Fm);
 | 
						|
floatx80 floatx80_ln(floatx80 Fm);
 | 
						|
floatx80 floatx80_sin(floatx80 rFm);
 | 
						|
floatx80 floatx80_cos(floatx80 rFm);
 | 
						|
floatx80 floatx80_arcsin(floatx80 rFm);
 | 
						|
floatx80 floatx80_arctan(floatx80 rFm);
 | 
						|
floatx80 floatx80_log(floatx80 rFm);
 | 
						|
floatx80 floatx80_tan(floatx80 rFm);
 | 
						|
floatx80 floatx80_arccos(floatx80 rFm);
 | 
						|
floatx80 floatx80_pow(floatx80 rFn,floatx80 rFm);
 | 
						|
floatx80 floatx80_pol(floatx80 rFn,floatx80 rFm);
 | 
						|
 | 
						|
unsigned int ExtendedCPDO(const unsigned int opcode)
 | 
						|
{
 | 
						|
   FPA11 *fpa11 = GET_FPA11();
 | 
						|
   floatx80 rFm, rFn;
 | 
						|
   unsigned int Fd, Fm, Fn, nRc = 1;
 | 
						|
 | 
						|
   //printk("ExtendedCPDO(0x%08x)\n",opcode);
 | 
						|
 | 
						|
   Fm = getFm(opcode);
 | 
						|
   if (CONSTANT_FM(opcode))
 | 
						|
   {
 | 
						|
     rFm = getExtendedConstant(Fm);
 | 
						|
   }
 | 
						|
   else
 | 
						|
   {
 | 
						|
     switch (fpa11->fType[Fm])
 | 
						|
     {
 | 
						|
        case typeSingle:
 | 
						|
          rFm = float32_to_floatx80(fpa11->fpreg[Fm].fSingle, &fpa11->fp_status);
 | 
						|
        break;
 | 
						|
 | 
						|
        case typeDouble:
 | 
						|
          rFm = float64_to_floatx80(fpa11->fpreg[Fm].fDouble, &fpa11->fp_status);
 | 
						|
        break;
 | 
						|
 | 
						|
        case typeExtended:
 | 
						|
          rFm = fpa11->fpreg[Fm].fExtended;
 | 
						|
        break;
 | 
						|
 | 
						|
        default: return 0;
 | 
						|
     }
 | 
						|
   }
 | 
						|
 | 
						|
   if (!MONADIC_INSTRUCTION(opcode))
 | 
						|
   {
 | 
						|
      Fn = getFn(opcode);
 | 
						|
      switch (fpa11->fType[Fn])
 | 
						|
      {
 | 
						|
        case typeSingle:
 | 
						|
          rFn = float32_to_floatx80(fpa11->fpreg[Fn].fSingle, &fpa11->fp_status);
 | 
						|
        break;
 | 
						|
 | 
						|
        case typeDouble:
 | 
						|
          rFn = float64_to_floatx80(fpa11->fpreg[Fn].fDouble, &fpa11->fp_status);
 | 
						|
        break;
 | 
						|
 | 
						|
        case typeExtended:
 | 
						|
          rFn = fpa11->fpreg[Fn].fExtended;
 | 
						|
        break;
 | 
						|
 | 
						|
        default: return 0;
 | 
						|
      }
 | 
						|
   }
 | 
						|
 | 
						|
   Fd = getFd(opcode);
 | 
						|
   switch (opcode & MASK_ARITHMETIC_OPCODE)
 | 
						|
   {
 | 
						|
      /* dyadic opcodes */
 | 
						|
      case ADF_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_add(rFn,rFm, &fpa11->fp_status);
 | 
						|
      break;
 | 
						|
 | 
						|
      case MUF_CODE:
 | 
						|
      case FML_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_mul(rFn,rFm, &fpa11->fp_status);
 | 
						|
      break;
 | 
						|
 | 
						|
      case SUF_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_sub(rFn,rFm, &fpa11->fp_status);
 | 
						|
      break;
 | 
						|
 | 
						|
      case RSF_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_sub(rFm,rFn, &fpa11->fp_status);
 | 
						|
      break;
 | 
						|
 | 
						|
      case DVF_CODE:
 | 
						|
      case FDV_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_div(rFn,rFm, &fpa11->fp_status);
 | 
						|
      break;
 | 
						|
 | 
						|
      case RDF_CODE:
 | 
						|
      case FRD_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_div(rFm,rFn, &fpa11->fp_status);
 | 
						|
      break;
 | 
						|
 | 
						|
#if 0
 | 
						|
      case POW_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_pow(rFn,rFm);
 | 
						|
      break;
 | 
						|
 | 
						|
      case RPW_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_pow(rFm,rFn);
 | 
						|
      break;
 | 
						|
#endif
 | 
						|
 | 
						|
      case RMF_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_rem(rFn,rFm, &fpa11->fp_status);
 | 
						|
      break;
 | 
						|
 | 
						|
#if 0
 | 
						|
      case POL_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_pol(rFn,rFm);
 | 
						|
      break;
 | 
						|
#endif
 | 
						|
 | 
						|
      /* monadic opcodes */
 | 
						|
      case MVF_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = rFm;
 | 
						|
      break;
 | 
						|
 | 
						|
      case MNF_CODE:
 | 
						|
         rFm.high ^= 0x8000;
 | 
						|
         fpa11->fpreg[Fd].fExtended = rFm;
 | 
						|
      break;
 | 
						|
 | 
						|
      case ABS_CODE:
 | 
						|
         rFm.high &= 0x7fff;
 | 
						|
         fpa11->fpreg[Fd].fExtended = rFm;
 | 
						|
      break;
 | 
						|
 | 
						|
      case RND_CODE:
 | 
						|
      case URD_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_round_to_int(rFm, &fpa11->fp_status);
 | 
						|
      break;
 | 
						|
 | 
						|
      case SQT_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_sqrt(rFm, &fpa11->fp_status);
 | 
						|
      break;
 | 
						|
 | 
						|
#if 0
 | 
						|
      case LOG_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_log(rFm);
 | 
						|
      break;
 | 
						|
 | 
						|
      case LGN_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_ln(rFm);
 | 
						|
      break;
 | 
						|
 | 
						|
      case EXP_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_exp(rFm);
 | 
						|
      break;
 | 
						|
 | 
						|
      case SIN_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_sin(rFm);
 | 
						|
      break;
 | 
						|
 | 
						|
      case COS_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_cos(rFm);
 | 
						|
      break;
 | 
						|
 | 
						|
      case TAN_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_tan(rFm);
 | 
						|
      break;
 | 
						|
 | 
						|
      case ASN_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_arcsin(rFm);
 | 
						|
      break;
 | 
						|
 | 
						|
      case ACS_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_arccos(rFm);
 | 
						|
      break;
 | 
						|
 | 
						|
      case ATN_CODE:
 | 
						|
         fpa11->fpreg[Fd].fExtended = floatx80_arctan(rFm);
 | 
						|
      break;
 | 
						|
#endif
 | 
						|
 | 
						|
      case NRM_CODE:
 | 
						|
      break;
 | 
						|
 | 
						|
      default:
 | 
						|
      {
 | 
						|
        nRc = 0;
 | 
						|
      }
 | 
						|
   }
 | 
						|
 | 
						|
   if (0 != nRc) fpa11->fType[Fd] = typeExtended;
 | 
						|
   return nRc;
 | 
						|
}
 | 
						|
 | 
						|
#if 0
 | 
						|
floatx80 floatx80_exp(floatx80 Fm)
 | 
						|
{
 | 
						|
//series
 | 
						|
}
 | 
						|
 | 
						|
floatx80 floatx80_ln(floatx80 Fm)
 | 
						|
{
 | 
						|
//series
 | 
						|
}
 | 
						|
 | 
						|
floatx80 floatx80_sin(floatx80 rFm)
 | 
						|
{
 | 
						|
//series
 | 
						|
}
 | 
						|
 | 
						|
floatx80 floatx80_cos(floatx80 rFm)
 | 
						|
{
 | 
						|
//series
 | 
						|
}
 | 
						|
 | 
						|
floatx80 floatx80_arcsin(floatx80 rFm)
 | 
						|
{
 | 
						|
//series
 | 
						|
}
 | 
						|
 | 
						|
floatx80 floatx80_arctan(floatx80 rFm)
 | 
						|
{
 | 
						|
  //series
 | 
						|
}
 | 
						|
 | 
						|
floatx80 floatx80_log(floatx80 rFm)
 | 
						|
{
 | 
						|
  return floatx80_div(floatx80_ln(rFm),getExtendedConstant(7));
 | 
						|
}
 | 
						|
 | 
						|
floatx80 floatx80_tan(floatx80 rFm)
 | 
						|
{
 | 
						|
  return floatx80_div(floatx80_sin(rFm),floatx80_cos(rFm));
 | 
						|
}
 | 
						|
 | 
						|
floatx80 floatx80_arccos(floatx80 rFm)
 | 
						|
{
 | 
						|
   //return floatx80_sub(halfPi,floatx80_arcsin(rFm));
 | 
						|
}
 | 
						|
 | 
						|
floatx80 floatx80_pow(floatx80 rFn,floatx80 rFm)
 | 
						|
{
 | 
						|
  return floatx80_exp(floatx80_mul(rFm,floatx80_ln(rFn)));
 | 
						|
}
 | 
						|
 | 
						|
floatx80 floatx80_pol(floatx80 rFn,floatx80 rFm)
 | 
						|
{
 | 
						|
  return floatx80_arctan(floatx80_div(rFn,rFm));
 | 
						|
}
 | 
						|
#endif
 |