clk: bcm: rpi: Add DT provider for the clocks (d4b4f1b6) · Commits · 戴 / test

drivers/clk/bcm/clk-raspberrypi.c

+16 −0

Original line number	Diff line number	Diff line
		@@ -31,6 +31,8 @@

		#define A2W_PLL_FRAC_BITS 20

		#define NUM_FW_CLKS 16

		struct raspberrypi_clk {
		struct device *dev;
		struct rpi_firmware *firmware;
		@@ -282,11 +284,13 @@ static struct clk_hw raspberrypi_register_pllb_arm(struct raspberrypi_clk rpi)

		static int raspberrypi_clk_probe(struct platform_device *pdev)
		{
		struct clk_hw_onecell_data *clk_data;
		struct device_node *firmware_node;
		struct device *dev = &pdev->dev;
		struct rpi_firmware *firmware;
		struct raspberrypi_clk *rpi;
		struct clk_hw *hw;
		int ret;

		/*
		* We can be probed either through the an old-fashioned
		@@ -316,6 +320,11 @@ static int raspberrypi_clk_probe(struct platform_device *pdev)
		rpi->firmware = firmware;
		platform_set_drvdata(pdev, rpi);

		clk_data = devm_kzalloc(dev, struct_size(clk_data, hws, NUM_FW_CLKS),
		GFP_KERNEL);
		if (!clk_data)
		return -ENOMEM;

		hw = raspberrypi_register_pllb(rpi);
		if (IS_ERR(hw)) {
		dev_err(dev, "Failed to initialize pllb, %ld\n", PTR_ERR(hw));
		@@ -325,6 +334,13 @@ static int raspberrypi_clk_probe(struct platform_device *pdev)
		hw = raspberrypi_register_pllb_arm(rpi);
		if (IS_ERR(hw))
		return PTR_ERR(hw);
		clk_data->hws[RPI_FIRMWARE_ARM_CLK_ID] = hw;
		clk_data->num = RPI_FIRMWARE_ARM_CLK_ID + 1;

		ret = devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get,
		clk_data);
		if (ret)
		return ret;

		rpi->cpufreq = platform_device_register_data(dev, "raspberrypi-cpufreq",
		-1, NULL, 0);