Added first version of FunnelObstacle. It is not very precise now
Added read/write check