General cleaning and restructure..Doxygen, gtests e.t.c.