Added Test Mode GUI and HSV colour thresholding