Remove old files
Math utils, with all math functions

Refactor on planners, thing and map class