It's best to test the hardware pieces each in its own sketch
Learn to do this event-driven (time is one kind of event) code approach and you won't need any timer library.
Run all your inputs, outputs and processes as separate tasks in loop(). It's easier to debug each one alone than all together.
Learn finite state machines to control all that very simply.
Learn these things and then look at your robot with new eyes.