Motor Delay

[zcase]

@JacopoPan do you know of a way to induce motor delay for a given time amount using the _pyhiics function or would we need to use the _dynamics function to do this?

Could we modify the step function to change:

if self.PHYSICS != Physics.DYN:
    p.stepSimulation(physicsClientId=self.CLIENT)

to

if self.PHYSICS != Physics.DYN:
    for _ in range(self.num_of_steps_for_dealy):
        p.stepSimulation(physicsClientId=self.CLIENT)

where the num_of_steps is calculated by doing something like:

motor_delay_ms = 100  # milliseconds
self.num_of_steps_for_dealy = int(pyb_freq * (motor_delay_ms / 1000))

I did try this but it seems to just instantly crash the drone.