Fix lineCrossRobot first conditional
Add test to cross functions