Fixed time mesurements
Added some debug output
fixed angle mapping in arduino