Got bilinear filtering working and doing calibration