Add hhr_vision.py to start creating old alg in Python