function cleanup and comments

- getThresh() minimized and cleaned
- Added comments throughout
- Removed unnecessary frames (from colours we don't care about)
- Reduced sleep time that waits for camera to start