UPDATING and ADDING source files

Signed-off-by: Jani Sinervo <jani.sinervo@gmail.com>