Added green ball detection, tuned controller