1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * Copyright (C) 2016 Atmel Corporation 4 * Wenyou.Yang <wenyou.yang@atmel.com> 5 */ 6 7 #include <common.h> 8 #include <clk-uclass.h> 9 #include <dm.h> 10 #include <linux/io.h> 11 #include <mach/at91_pmc.h> 12 #include "pmc.h" 13 14 DECLARE_GLOBAL_DATA_PTR; 15 16 static int main_osc_clk_enable(struct clk *clk) 17 { 18 struct pmc_platdata *plat = dev_get_platdata(clk->dev); 19 struct at91_pmc *pmc = plat->reg_base; 20 21 if (readl(&pmc->sr) & AT91_PMC_MOSCSELS) 22 return 0; 23 24 return -EINVAL; 25 } 26 27 static ulong main_osc_clk_get_rate(struct clk *clk) 28 { 29 return gd->arch.main_clk_rate_hz; 30 } 31 32 static struct clk_ops main_osc_clk_ops = { 33 .enable = main_osc_clk_enable, 34 .get_rate = main_osc_clk_get_rate, 35 }; 36 37 static int main_osc_clk_probe(struct udevice *dev) 38 { 39 return at91_pmc_core_probe(dev); 40 } 41 42 static const struct udevice_id main_osc_clk_match[] = { 43 { .compatible = "atmel,at91sam9x5-clk-main" }, 44 {} 45 }; 46 47 U_BOOT_DRIVER(at91sam9x5_main_osc_clk) = { 48 .name = "at91sam9x5-main-osc-clk", 49 .id = UCLASS_CLK, 50 .of_match = main_osc_clk_match, 51 .probe = main_osc_clk_probe, 52 .platdata_auto_alloc_size = sizeof(struct pmc_platdata), 53 .ops = &main_osc_clk_ops, 54 }; 55