Took camera delay into account in EKF update + updated todo list