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