Changed so sensor angle is part of the measure callback instead of
being saved during the update phase.
Fixed GUI drawing and removed some redundant code.