testfeld.cpp

来自「this the code of bootstation」· C++ 代码 · 共 52 行

#if _MSC_VER > 1000
#include "stdafx.h"		//in MFC einkommentieren, sonst raus!


#include "Testfeld.h"


void Testfeld()
{
	double temp_a;
	double temp_b;


	Test_Entf_oben = 5 - Hoehe_m;
	Test_Entf_unten = Hoehe_m;

	//Sensordaten anhand der aktuellen Position generieren
	//Division dur Null verhindern durch abfangen der Sonderf鋖le
		if (Richtung_ist[0] == 0)
		{
			Test_Entf_vorne = y_Ende - Pos_y;
			Test_Entf_hinten = Pos_y;
			Test_Entf_rechts = x_Ende - Pos_x;
			Test_Entf_links = Pos_x;		
		}

		if (Richtung_ist[0] == -90)
		{
			Test_Entf_vorne = x_Ende - Pos_x;
			Test_Entf_hinten = Pos_x;
			Test_Entf_rechts = Pos_y;
			Test_Entf_links = y_Ende - Pos_y;		
		}
		if (Richtung_ist[0] == 90)
		{
			Test_Entf_vorne = Pos_x;
			Test_Entf_hinten = x_Ende - Pos_x;
			Test_Entf_rechts = y_Ende - Pos_y;
			Test_Entf_links = Pos_y;		
		}
		if (Richtung_ist[0] == 180 || Richtung_ist[0] == -180)
		{
			Test_Entf_vorne = Pos_y;
			Test_Entf_hinten = y_Ende - Pos_y;
			Test_Entf_rechts = Pos_x;
			Test_Entf_links = x_Ende - Pos_x;		
		}
		
	//Sensordaten anhand der aktuellen Position generieren
	//Testumgebung ist in vier Quadranten aufgeteilt, zur korrekten Berechnung der
	//der Sensordaten anhand der aktuellen Position und Richtung (0