Added original source code

Signed-off-by: Stig Hornang <shornang@gmail.com>