pid1.c go back to the original design. drop the state machine design.