[CODE] First commit, added all source code

Initial commit to release a first version of the code.
Proper comments and documentation (including readme) to be completed.


Signed-off-by: Francesco Robino <frobino@kth.se>