Added geogebra model for visualisation of width calculations with goal
Added code to do visionkin for localising goals and obstacles