Weak pid control for upward motion, angle not stable
WIP
first iteration of Serial communication working
updated first iteration GUI
pid up
moved some variables to globals
Merge branch 'feature/serial' into develop
Merged in serial code