Fixed some bugs

All Hardware 100% Woking
WORKING 80%

WITH 11.1V AND 14.4V