Actually set focus mode

Changes from piemonte/PBJVision#61
Merge pull request #92 from wilg/focus-mode

Actually set focus mode