Code not well organized

[ElisaLegnani]

There is the need to have a function.h file with commonly used functions, like are_close() that now is in colors.h.