// Reference positions by doing point# * 3 + (0 for
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) { // Reference positions by doing point# * 3 + (0 for
// x, 1 for y, 2 for heading)
posLog.add(x);
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) { // Reference positions by doing point# * 3 + (0 for
// x, 1 for y, 2 for heading)
posLog.add(x);
posLog.add(y);
posLog.add(heading);
}