pl35x-nand-controller: Enable dynamic clk rate setting

    Bluefin devices require different clk frequencies to be set at
    different timing modes. Enable the memclk rate to be set according
    to the specifications in the device tree. If the device tree does
    not have this memclk-timing-frequency property specified, the driver
    proceeds as usual.

Signed-off-by: deooi <deborah.ooi@ni.com>

Author: deooi

arch/arm/boot/dts/xilinx/ni-zynq.dtsi

@@ -140,6 +140,16 @@
 
 &smcc {
 	status = "okay";
+	/*
+	 * Bluefin devices require different memclk frequency
+	 * for different timing modes
+	 */
+	memclk-timing-frequency = <0 83333333>,
+							<1 166666666>,
+							<2 166666666>,
+							<3 166666666>,
+							<4 166666666>,
+							<5 166666666>;
 };
 
 &nfc0 {

drivers/mtd/nand/raw/pl35x-nand-controller.c

@@ -795,6 +795,22 @@ static int pl35x_nfc_exec_op(struct nand_chip *chip,
 				      op, check_only);
 }
 
+static unsigned long get_special_timing_freq(const struct device_node *np, int timing_mode)
+{
+	int len, i;
+
+	const __be32 *memclk_timing_freq = of_get_property(np, "memclk-timing-frequency", &len);
+
+	if (memclk_timing_freq) {
+		for (i = 0; i < len / sizeof(u32) / 2; i++) {
+			if (timing_mode == be32_to_cpu(memclk_timing_freq[i * 2])) {
+				return be32_to_cpu(memclk_timing_freq[i * 2 + 1]);
+			};
+		}
+	}
+	return 0;
+}
+
 static int pl35x_nfc_setup_interface(struct nand_chip *chip, int cs,
 				     const struct nand_interface_config *conf)
 {
@@ -804,6 +820,8 @@ static int pl35x_nfc_setup_interface(struct nand_chip *chip, int cs,
 	const struct nand_sdr_timings *sdr;
 	unsigned int period_ns, val;
 	struct clk *mclk;
+	unsigned long special_timing_freq;
+	int ret = 0;
 
 	sdr = nand_get_sdr_timings(conf);
 	if (IS_ERR(sdr))
@@ -815,6 +833,20 @@ static int pl35x_nfc_setup_interface(struct nand_chip *chip, int cs,
 		return PTR_ERR(mclk);
 	}
 
+	/*
+	 * Bluefin devices require different rates for different timing modes
+	 * so we need to set the rate according to the timing modes
+	 */
+	special_timing_freq = get_special_timing_freq(
+		nfc->dev->parent->of_node,
+		conf->timings.mode);
+
+	if (special_timing_freq) {
+		ret = clk_set_rate(mclk, special_timing_freq);
+		if (ret)
+			return -EINVAL;
+	}
+
 	/*
 	 * SDR timings are given in pico-seconds while NFC timings must be
 	 * expressed in NAND controller clock cycles. We use the TO_CYCLE()