Add Odometry. Fix bugs of Processor.
add simulation rate