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

Some refactoring, separating node type from node instance. Added parameters, and disabled ability to set inputs.