delete unneeded code; code refactoring;
added PID algorithm; need to calculate PWM values for ESC controllers