init timestamps to zero instead of current time, prevent timing problems at start-up
moved switch logic to update loop
mutex/locks for thread safety
switched to enum instead of string
Merge pull request #10 from ipa-mdl/indigo_new_structure

Update control mode switch logic