fixed #290; reworked timing
Merge pull request #18 from OpenROV/bug/290

fixed #290