Moved yaw correction to its proper location (between velocity PID output and before pitch/roll PID input).
Eliminated leftover graph_add_node_SpecificTypeHere() functions.

Shuffled around #include dependencies to allow the control algorithm diagram to be generated without copying code out of control_algorithm.c