Use function for setting params based on current time
Add turning servo
Init servo correctly
Takes working data over TWI