A simple ROS script which gives a numeric value for how well a camera lens is focused in a region
How to use: Supply the subscribed image topics to focusTool.py Execute: python focusTool.py Place the object of interest inside field of view of the blue box at the desired focus distance. Manually modify the lens until the focus number is maximized