Dissertation-Endstand3 - KLUEDO - Universität Kaiserslautern

Anhang 79
else {
Px = -999.9;
Py = -999.9;
return false;
}
}
bool SchnittGradeGrade(const double Ax,const double Ay,
const double Bx,const double By,
const double Cx,const double Cy,
const double Dx,const double Dy,
double& Px,double& Py)
{
double nenner = (Bx-Ax)*(Dy-Cy)-(By-Ay)*(Dx-Cx);
if (nenner == 0) {
Px = -999.9;
Py = -999.9;
return false;
}
double r = ( (Ay-Cy)*(Dx-Cx)-(Ax-Cx)*(Dy-Cy) ) / nenner ;
Px = Ax + r * (Bx-Ax);
Py = Ay + r * (By-Ay);
return true;
}
double Abstand(const double Ax,const double Ay,
const double Bx,const double By)
{
return sqrt( (Bx-Ax)*(Bx-Ax) + (By-Ay) * (By-Ay) ) ;
}
//-------------------------------------------------------------------
// Hilfsfunktionen fuer die Zeitberechnung
double ZeitBeiDurchstoss (const double Ax,const double Ay,
const double Bx,const double By,
const double Px,const double Py,
const double At,const double Bt)
{
double dAB = Abstand(Ax, Ay, Bx, By);
double dAP = Abstand(Ax, Ay, Px, Py);
return ( dAP/dAB * (Bt - At) ) + At;
}
double ZeitExtrapoliert(const double Ax,const double Ay,
const double Bx,const double By,
const double Px,const double Py,
const double At,const double Bt)
{
double dAP = Abstand(Ax, Ay, Px, Py);
double dBP = Abstand(Bx, By, Px, Py);
return ( dAP*Bt - dBP*At ) / ( dAP- dBP) ;
}
//-------------------------------------------------------------------
// Datenspeicher fuer Fahrzeug-Positionen
struct Position {
static const double INVALIDDOUBLE;
double x,y;
bool valid;
Position() {
x = INVALIDDOUBLE ;
y = INVALIDDOUBLE ;
valid = false;
}
friend ostream& operator