Guidance System for a rocket, C++, Arduino