Modified drive.*, gpio.*, pwm.* to solve the bug.
Adding VFHNavigation navigation algorithm.
Adding joystick library.