A digital servo system of an optical disk drive with a calibrated inverse non-linearity function is disclosed. A look-up table is determined, for example, with a focus error signal gain corresponding with a focus error signal offset so that the response of the focus servo system is substantially linear. Additionally, the look-up table can include tracking error signal gain, tracking error signal offset, or tracking loop gain parameters corresponding with the focus error signal offset.