Refined some timing and adjusted the way sensor and filter are related. Added a plotting tool for lcm messages.