Modified the makefile to add flags
Optimization complete

Replaced a list with an unordered map, no slowdown to be seen
Added compiler flag
Built structure for vision alg