Fixes for door passing behaviour

Two changes:

1) counts misdetections which were previously ignoring, causing it to never fail when not facing a door.

2) changed passCounter reset to -30 instead of -50 which stops the robot a little earlier when moving successful. this prevents Bob for charging off down a corridor when leaving an office.

Also added a little more logging for me to understand things and switched to ros rate objects for clarity.