49 struct axi_clkgen {  struct
213 static void axi_clkgen_write(struct axi_clkgen *axi_clkgen,  in axi_clkgen_write()  argument
216 	writel(val, axi_clkgen->base + reg);  in axi_clkgen_write()
219 static void axi_clkgen_read(struct axi_clkgen *axi_clkgen,  in axi_clkgen_read()  argument
222 	*val = readl(axi_clkgen->base + reg);  in axi_clkgen_read()
225 static int axi_clkgen_wait_non_busy(struct axi_clkgen *axi_clkgen)  in axi_clkgen_wait_non_busy()  argument
231 		axi_clkgen_read(axi_clkgen, AXI_CLKGEN_V2_REG_DRP_STATUS, &val);  in axi_clkgen_wait_non_busy()
240 static int axi_clkgen_mmcm_read(struct axi_clkgen *axi_clkgen,  in axi_clkgen_mmcm_read()  argument
246 	ret = axi_clkgen_wait_non_busy(axi_clkgen);  in axi_clkgen_mmcm_read()
253 	axi_clkgen_write(axi_clkgen, AXI_CLKGEN_V2_REG_DRP_CNTRL, reg_val);  in axi_clkgen_mmcm_read()
255 	ret = axi_clkgen_wait_non_busy(axi_clkgen);  in axi_clkgen_mmcm_read()
264 static int axi_clkgen_mmcm_write(struct axi_clkgen *axi_clkgen,  in axi_clkgen_mmcm_write()  argument
270 	ret = axi_clkgen_wait_non_busy(axi_clkgen);  in axi_clkgen_mmcm_write()
275 		axi_clkgen_mmcm_read(axi_clkgen, reg, &reg_val);  in axi_clkgen_mmcm_write()
281 	axi_clkgen_write(axi_clkgen, AXI_CLKGEN_V2_REG_DRP_CNTRL, reg_val);  in axi_clkgen_mmcm_write()
286 static void axi_clkgen_mmcm_enable(struct axi_clkgen *axi_clkgen,  in axi_clkgen_mmcm_enable()  argument
294 	axi_clkgen_write(axi_clkgen, AXI_CLKGEN_V2_REG_RESET, val);  in axi_clkgen_mmcm_enable()
297 static struct axi_clkgen *clk_hw_to_axi_clkgen(struct clk_hw *clk_hw)  in clk_hw_to_axi_clkgen()
299 	return container_of(clk_hw, struct axi_clkgen, clk_hw);  in clk_hw_to_axi_clkgen()
302 static void axi_clkgen_set_div(struct axi_clkgen *axi_clkgen,  in axi_clkgen_set_div()  argument
306 	axi_clkgen_mmcm_write(axi_clkgen, reg1,  in axi_clkgen_set_div()
308 	axi_clkgen_mmcm_write(axi_clkgen, reg2,  in axi_clkgen_set_div()
313 		axi_clkgen_mmcm_write(axi_clkgen, reg3,  in axi_clkgen_set_div()
321 	struct axi_clkgen *axi_clkgen = clk_hw_to_axi_clkgen(clk_hw);  in axi_clkgen_set_rate()  local
339 	axi_clkgen_mmcm_write(axi_clkgen, MMCM_REG_POWER, power, 0x9800);  in axi_clkgen_set_rate()
345 	axi_clkgen_set_div(axi_clkgen,  MMCM_REG_CLKOUT0_1, MMCM_REG_CLKOUT0_2,  in axi_clkgen_set_rate()
349 	axi_clkgen_mmcm_write(axi_clkgen, MMCM_REG_CLK_DIV,  in axi_clkgen_set_rate()
354 	axi_clkgen_set_div(axi_clkgen,  MMCM_REG_CLK_FB1, MMCM_REG_CLK_FB2,  in axi_clkgen_set_rate()
357 	axi_clkgen_mmcm_write(axi_clkgen, MMCM_REG_LOCK1, lock & 0x3ff, 0x3ff);  in axi_clkgen_set_rate()
358 	axi_clkgen_mmcm_write(axi_clkgen, MMCM_REG_LOCK2,  in axi_clkgen_set_rate()
360 	axi_clkgen_mmcm_write(axi_clkgen, MMCM_REG_LOCK3,  in axi_clkgen_set_rate()
362 	axi_clkgen_mmcm_write(axi_clkgen, MMCM_REG_FILTER1, filter >> 16, 0x9900);  in axi_clkgen_set_rate()
363 	axi_clkgen_mmcm_write(axi_clkgen, MMCM_REG_FILTER2, filter, 0x9900);  in axi_clkgen_set_rate()
385 static unsigned int axi_clkgen_get_div(struct axi_clkgen *axi_clkgen,  in axi_clkgen_get_div()  argument
391 	axi_clkgen_mmcm_read(axi_clkgen, reg2, &val2);  in axi_clkgen_get_div()
395 	axi_clkgen_mmcm_read(axi_clkgen, reg1, &val1);  in axi_clkgen_get_div()
415 	struct axi_clkgen *axi_clkgen = clk_hw_to_axi_clkgen(clk_hw);  in axi_clkgen_recalc_rate()  local
420 	dout = axi_clkgen_get_div(axi_clkgen, MMCM_REG_CLKOUT0_1,  in axi_clkgen_recalc_rate()
422 	m = axi_clkgen_get_div(axi_clkgen, MMCM_REG_CLK_FB1,  in axi_clkgen_recalc_rate()
425 	axi_clkgen_mmcm_read(axi_clkgen, MMCM_REG_CLK_DIV, &val);  in axi_clkgen_recalc_rate()
442 	struct axi_clkgen *axi_clkgen = clk_hw_to_axi_clkgen(clk_hw);  in axi_clkgen_enable()  local
444 	axi_clkgen_mmcm_enable(axi_clkgen, true);  in axi_clkgen_enable()
451 	struct axi_clkgen *axi_clkgen = clk_hw_to_axi_clkgen(clk_hw);  in axi_clkgen_disable()  local
453 	axi_clkgen_mmcm_enable(axi_clkgen, false);  in axi_clkgen_disable()
458 	struct axi_clkgen *axi_clkgen = clk_hw_to_axi_clkgen(clk_hw);  in axi_clkgen_set_parent()  local
460 	axi_clkgen_write(axi_clkgen, AXI_CLKGEN_V2_REG_CLKSEL, index);  in axi_clkgen_set_parent()
467 	struct axi_clkgen *axi_clkgen = clk_hw_to_axi_clkgen(clk_hw);  in axi_clkgen_get_parent()  local
470 	axi_clkgen_read(axi_clkgen, AXI_CLKGEN_V2_REG_CLKSEL, &parent);  in axi_clkgen_get_parent()
496 	struct axi_clkgen *axi_clkgen;  in axi_clkgen_probe()  local
511 	axi_clkgen = devm_kzalloc(&pdev->dev, sizeof(*axi_clkgen), GFP_KERNEL);  in axi_clkgen_probe()
512 	if (!axi_clkgen)  in axi_clkgen_probe()
516 	axi_clkgen->base = devm_ioremap_resource(&pdev->dev, mem);  in axi_clkgen_probe()
517 	if (IS_ERR(axi_clkgen->base))  in axi_clkgen_probe()
518 		return PTR_ERR(axi_clkgen->base);  in axi_clkgen_probe()
539 	axi_clkgen_mmcm_enable(axi_clkgen, false);  in axi_clkgen_probe()
541 	axi_clkgen->clk_hw.init = &init;  in axi_clkgen_probe()
542 	ret = devm_clk_hw_register(&pdev->dev, &axi_clkgen->clk_hw);  in axi_clkgen_probe()
547 				      &axi_clkgen->clk_hw);  in axi_clkgen_probe()