| .. | .. |
|---|
| 2 | 2 | /* |
|---|
| 3 | 3 | * Copyright (C) 2020 Rockchip Electronics Co., Ltd. |
|---|
| 4 | 4 | */ |
|---|
| 5 | +#include <linux/clk.h> |
|---|
| 5 | 6 | #include <linux/iopoll.h> |
|---|
| 6 | 7 | #include <linux/kernel.h> |
|---|
| 7 | 8 | #include <linux/kthread.h> |
|---|
| .. | .. |
|---|
| 27 | 28 | struct resource *res; |
|---|
| 28 | 29 | struct device_node *rds, *rdd, *dma; |
|---|
| 29 | 30 | struct device *dev = &pdev->dev; |
|---|
| 31 | + struct clk_bulk_data *clk_bulks; |
|---|
| 32 | + int clk_num; |
|---|
| 30 | 33 | u32 status; |
|---|
| 31 | 34 | |
|---|
| 32 | 35 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
|---|
| .. | .. |
|---|
| 39 | 42 | rds = of_parse_phandle(dev->of_node, "memory-region-src", 0); |
|---|
| 40 | 43 | rdd = of_parse_phandle(dev->of_node, "memory-region-dst", 0); |
|---|
| 41 | 44 | dma = of_parse_phandle(dev->of_node, "memory-region-idmac", 0); |
|---|
| 45 | + |
|---|
| 46 | + clk_num = clk_bulk_get_all(&pdev->dev, &clk_bulks); |
|---|
| 47 | + if (clk_num >= 0) { |
|---|
| 48 | + ret = clk_bulk_prepare_enable(clk_num, clk_bulks); |
|---|
| 49 | + if (ret) { |
|---|
| 50 | + dev_err(&pdev->dev, "failed to enable clocks\n"); |
|---|
| 51 | + return ret; |
|---|
| 52 | + } |
|---|
| 53 | + } else { |
|---|
| 54 | + dev_err(&pdev->dev, "failed to get clks property\\n"); |
|---|
| 55 | + return clk_num; |
|---|
| 56 | + } |
|---|
| 42 | 57 | |
|---|
| 43 | 58 | if (readl_poll_timeout(regs + SDMMC_STATUS, status, |
|---|
| 44 | 59 | !(status & (BIT(10) | GENMASK(7, 4))), 100, |
|---|
| .. | .. |
|---|
| 95 | 110 | } |
|---|
| 96 | 111 | |
|---|
| 97 | 112 | out: |
|---|
| 113 | + clk_bulk_disable_unprepare(clk_num, clk_bulks); |
|---|
| 114 | + clk_bulk_put_all(clk_num, clk_bulks); |
|---|
| 98 | 115 | of_node_put(rds); |
|---|
| 99 | 116 | of_node_put(rdd); |
|---|
| 100 | 117 | of_node_put(dma); |
|---|