* move tiny side move filter _before_ the safety heigth filter
* simplify the code by using pnear instead of manual point comparisons