/*
 * Notbremse.cpp
 *
 *  Created on: 01.12.2010
 *      Author: sven
 */

#include "Notbremse.h"
#include <iostream>
#include <stdlib.h>
#include <cmath>
using namespace std;

Notbremse::Notbremse(int t)
:Task(t),DIST_THRESHOLD(50)
{
}

Notbremse::~Notbremse() {
	// TODO Auto-generated destructor stub
}
void Notbremse::execute() {
	cout << "...Notbremse::executeT=" << T <<endl;
	while(true) {
		pthread_mutex_lock(&vehicleMutex);
		double dist = Abstand(vehiclePosition,lineDir);
		if(abs(dist) > DIST_THRESHOLD) {
			cout << "NOTBREMSE" << endl;
			exit(1);
		}
		pthread_mutex_unlock(&vehicleMutex);
		waitForNextCycle();
	}
}