NFC_PROTO_ISO15693_MASK | NFC_PROTO_NFC_DEP_MASK)
 
 #define TRF7970A_AUTOSUSPEND_DELAY             30000 /* 30 seconds */
+#define TRF7970A_13MHZ_CLOCK_FREQUENCY         13560000
+#define TRF7970A_27MHZ_CLOCK_FREQUENCY         27120000
+
 
 #define TRF7970A_RX_SKB_ALLOC_SIZE             256
 
 
        trf->chip_status_ctrl &= ~TRF7970A_CHIP_STATUS_RF_ON;
 
-       ret = trf7970a_write(trf, TRF7970A_MODULATOR_SYS_CLK_CTRL, 0);
+       ret = trf7970a_write(trf, TRF7970A_MODULATOR_SYS_CLK_CTRL,
+                       trf->modulator_sys_clk_ctrl);
        if (ret)
                goto err_out;
 
-       trf->modulator_sys_clk_ctrl = 0;
-
        ret = trf7970a_write(trf, TRF7970A_ADJUTABLE_FIFO_IRQ_LEVELS,
                        TRF7970A_ADJUTABLE_FIFO_IRQ_LEVELS_WLH_96 |
                        TRF7970A_ADJUTABLE_FIFO_IRQ_LEVELS_WLL_32);
        switch (tech) {
        case NFC_DIGITAL_RF_TECH_106A:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_14443A_106;
-               trf->modulator_sys_clk_ctrl = TRF7970A_MODULATOR_DEPTH_OOK;
+               trf->modulator_sys_clk_ctrl =
+                       (trf->modulator_sys_clk_ctrl & 0xf8) |
+                       TRF7970A_MODULATOR_DEPTH_OOK;
                trf->guard_time = TRF7970A_GUARD_TIME_NFCA;
                break;
        case NFC_DIGITAL_RF_TECH_106B:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_14443B_106;
-               trf->modulator_sys_clk_ctrl = TRF7970A_MODULATOR_DEPTH_ASK10;
+               trf->modulator_sys_clk_ctrl =
+                       (trf->modulator_sys_clk_ctrl & 0xf8) |
+                       TRF7970A_MODULATOR_DEPTH_ASK10;
                trf->guard_time = TRF7970A_GUARD_TIME_NFCB;
                break;
        case NFC_DIGITAL_RF_TECH_212F:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_FELICA_212;
-               trf->modulator_sys_clk_ctrl = TRF7970A_MODULATOR_DEPTH_ASK10;
+               trf->modulator_sys_clk_ctrl =
+                       (trf->modulator_sys_clk_ctrl & 0xf8) |
+                       TRF7970A_MODULATOR_DEPTH_ASK10;
                trf->guard_time = TRF7970A_GUARD_TIME_NFCF;
                break;
        case NFC_DIGITAL_RF_TECH_424F:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_FELICA_424;
-               trf->modulator_sys_clk_ctrl = TRF7970A_MODULATOR_DEPTH_ASK10;
+               trf->modulator_sys_clk_ctrl =
+                       (trf->modulator_sys_clk_ctrl & 0xf8) |
+                       TRF7970A_MODULATOR_DEPTH_ASK10;
                trf->guard_time = TRF7970A_GUARD_TIME_NFCF;
                break;
        case NFC_DIGITAL_RF_TECH_ISO15693:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_15693_SGL_1OF4_2648;
-               trf->modulator_sys_clk_ctrl = TRF7970A_MODULATOR_DEPTH_OOK;
+               trf->modulator_sys_clk_ctrl =
+                       (trf->modulator_sys_clk_ctrl & 0xf8) |
+                       TRF7970A_MODULATOR_DEPTH_OOK;
                trf->guard_time = TRF7970A_GUARD_TIME_15693;
                break;
        default:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_NFC_NFC_CE_MODE |
                        TRF7970A_ISO_CTRL_NFC_CE |
                        TRF7970A_ISO_CTRL_NFC_CE_14443A;
-               trf->modulator_sys_clk_ctrl = TRF7970A_MODULATOR_DEPTH_OOK;
+               trf->modulator_sys_clk_ctrl =
+                       (trf->modulator_sys_clk_ctrl & 0xf8) |
+                       TRF7970A_MODULATOR_DEPTH_OOK;
                break;
        case NFC_DIGITAL_RF_TECH_212F:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_NFC_NFC_CE_MODE |
                        TRF7970A_ISO_CTRL_NFC_NFCF_212;
-               trf->modulator_sys_clk_ctrl = TRF7970A_MODULATOR_DEPTH_ASK10;
+               trf->modulator_sys_clk_ctrl =
+                       (trf->modulator_sys_clk_ctrl & 0xf8) |
+                       TRF7970A_MODULATOR_DEPTH_ASK10;
                break;
        case NFC_DIGITAL_RF_TECH_424F:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_NFC_NFC_CE_MODE |
                        TRF7970A_ISO_CTRL_NFC_NFCF_424;
-               trf->modulator_sys_clk_ctrl = TRF7970A_MODULATOR_DEPTH_ASK10;
+               trf->modulator_sys_clk_ctrl =
+                       (trf->modulator_sys_clk_ctrl & 0xf8) |
+                       TRF7970A_MODULATOR_DEPTH_ASK10;
                break;
        default:
                dev_dbg(trf->dev, "Unsupported rf technology: %d\n", tech);
        struct device_node *np = spi->dev.of_node;
        struct trf7970a *trf;
        int uvolts, autosuspend_delay, ret;
+       u32 clk_freq = TRF7970A_13MHZ_CLOCK_FREQUENCY;
 
        if (!np) {
                dev_err(&spi->dev, "No Device Tree entry\n");
                }
        }
 
+       of_property_read_u32(np, "clock-frequency", &clk_freq);
+       if ((clk_freq != TRF7970A_27MHZ_CLOCK_FREQUENCY) ||
+               (clk_freq != TRF7970A_13MHZ_CLOCK_FREQUENCY)) {
+               dev_err(trf->dev,
+                       "clock-frequency (%u Hz) unsupported\n",
+                       clk_freq);
+               return -EINVAL;
+       }
+
        if (of_property_read_bool(np, "en2-rf-quirk"))
                trf->quirks |= TRF7970A_QUIRK_EN2_MUST_STAY_LOW;