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