freePoint.m

function out = freePoint(p, regions)
num_regions = sum(~cellfun('isempty', regions));
flag1 = false(num_regions,1);
flag2 = false(num_regions,1);
for i = 1:num_regions
    flag1(i) = inpolygon(p(1,1), p(1,2), regions{i}(:,1), regions{i}(:,2));
end
for i = 1:num_regions
    flag2(i) = inpolygon(p(2,1), p(2,2), regions{i}(:,1), regions{i}(:,2));
end
flag1 = any(flag1);
flag2 = any(flag2);
if ~any([flag1 flag2])
    out = p(1,:);
elseif all([flag1 flag2])
    ME = MException('VerifyOutput:OutOfBounds', ...
    'Error in freePoint, neither point was free');
    throw(ME);
elseif flag2
    out = p(1,:);
else
    out = p(2,:);
end