Got bilateral filter working