Got the RC inputs working properly. Working on printing the next waypoint but the microcontroller keeps freezing halfway through flashing.