Added Timer driver and reverted to multi-vector ISR