sdu_frobomower_wptnav: Working on a CASMOBOT inspired  area coverage algorithm