public void updatePosLog(double x, double y, double heading) { // Reference positions by doing point# * 3 + (0 for
																	// x, 1 for y, 2 for heading)
		posLog.add(x);
		posLog.add(y);
		posLog.add(heading);
	}
public void updatePosLog(double x, double y, double heading) { 																
		posLog.add(x);
		posLog.add(y);
		posLog.add(heading);
	}
public void updateposlog(double x, double y, double heading) { poslog.add(x); poslog.add(y); poslog.add(heading); }