Some Validation fixes [incomplete]

Tried to fix the code witch fails on the unit tests. Failed so far.
Added Coord2D class

Now we wont pass coordinates as int[] but as Coord2D instead. It's a bit
safer.