finished debugging everything.
next step is to test the program by flying the quad.