Hover_Egg_Arduino: Implemented dampening + Clean

Cleaning the code, implemented dampening, implemented plot function for
Simplot.