2021-07-14 20:23:00 +02:00
|
|
|
function ret = exitCondition(this, ovenObj, PositionVector, VelocityVector, CollisionEvent)
|
2021-07-11 14:35:54 +02:00
|
|
|
d = Helper.calculateDistanceFromPointToLine(PositionVector, [0 0 0], [0 1 0]);
|
|
|
|
|
y = PositionVector(2);
|
|
|
|
|
DivergenceAngle = (d/abs(y));
|
|
|
|
|
%DivergenceAngle = atan(norm(cross(PositionVector, )) / norm(dot(PositionVector, [0 1 0])));
|
2021-07-14 20:23:00 +02:00
|
|
|
if (y >= 0) && (DivergenceAngle <= this.ExitDivergence) && (abs(VelocityVector(2))<=ovenObj.VelocityCutoff) && ~CollisionEvent
|
2021-07-11 14:35:54 +02:00
|
|
|
ret = true;
|
|
|
|
|
else
|
|
|
|
|
ret = false;
|
|
|
|
|
end
|
|
|
|
|
end
|
