Fixed control loop hitting ros time