improved p controller
improved measure_sample_rate
use of measure sample rate object from ottocar_utils instead of local class