//**********************************//
//	源 文 件:math.c					//
//	描    述:數學計算				//
//	主要功能:點到點的距離計算		//
//	編寫作者:by Gholt(林青)			//
//  編寫日期:2005-09-07				//
//  整理日期:2005-10-30				//
//**********************************//

#include "math.h"
#include "SPCE061V004.H"
//線與定滑輪的觸點坐標 左:(Lx,Ly) 右:(Rx,Ry)
double Lx=-13.5,Ly=116.0,Rx=93.5,Ry=116.0;

//======================================================
//函數:void L12(double x,double y,double *s1,double *s2)
//語法:void L12(double x,double y,double *s1,double *s2)
//描述:計算點(x,y)到兩定滑輪的距離s1、s2
//參數:坐標點(x,y)，指向存放點到滑輪距離的指針s1、s2
//返回:無
//======================================================
void L12(double x,double y,double *s1,double *s2)
{
	double L1,L2;
	double Dx,Dy;
	Dx = x - Lx;
	Dy = y - Ly;
	Dx *= Dx;
	Dy *= Dy;
	L1 = sqrt(Dx+Dy);
	*s1=L1;
	*P_Watchdog_Clear = 1;
	Dx = Rx - x;
	Dy = Ry - y;
	Dx *= Dx;
	Dy *= Dy;
	L2 = sqrt(Dx+Dy);
	*s2=L2;
}