Made Control keep track of PID, changed State enum, moved state and mode strings to an array instead of switch case