Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Stelian Pop | d1aea1c | 2008-01-30 21:15:54 +0000 | [diff] [blame] | 2 | /* |
3 | * (C) Copyright 2006 | ||||
Stelian Pop | f9e848b | 2008-05-08 22:52:09 +0200 | [diff] [blame] | 4 | * DENX Software Engineering <mk@denx.de> |
Stelian Pop | d1aea1c | 2008-01-30 21:15:54 +0000 | [diff] [blame] | 5 | */ |
6 | |||||
7 | #include <common.h> | ||||
Jean-Christophe PLAGNIOL-VILLARD | 23164f1 | 2009-04-16 21:30:44 +0200 | [diff] [blame] | 8 | #include <asm/arch/clk.h> |
Stelian Pop | d1aea1c | 2008-01-30 21:15:54 +0000 | [diff] [blame] | 9 | |
10 | int usb_cpu_init(void) | ||||
11 | { | ||||
Bo Shen | 4a985df | 2013-10-21 16:14:00 +0800 | [diff] [blame] | 12 | #ifdef CONFIG_USB_ATMEL_CLK_SEL_PLLB |
Wenyou Yang | cb88cd8 | 2016-02-03 10:20:44 +0800 | [diff] [blame] | 13 | if (at91_pllb_clk_enable(get_pllb_init())) |
14 | return -1; | ||||
15 | |||||
Bo Shen | 8ed8783 | 2013-10-21 16:13:59 +0800 | [diff] [blame] | 16 | #ifdef CONFIG_AT91SAM9N12 |
Wenyou Yang | 2f7be64 | 2016-02-02 11:11:53 +0800 | [diff] [blame] | 17 | at91_usb_clk_init(AT91_PMC_USBS_USB_PLLB | AT91_PMC_USB_DIV_2); |
Bo Shen | 8ed8783 | 2013-10-21 16:13:59 +0800 | [diff] [blame] | 18 | #endif |
Bo Shen | 4a985df | 2013-10-21 16:14:00 +0800 | [diff] [blame] | 19 | #elif defined(CONFIG_USB_ATMEL_CLK_SEL_UPLL) |
Wenyou Yang | 2f7be64 | 2016-02-02 11:11:53 +0800 | [diff] [blame] | 20 | if (at91_upll_clk_enable()) |
21 | return -1; | ||||
Sergey Matyukevich | d25010d | 2010-06-09 23:09:06 +0400 | [diff] [blame] | 22 | |
Wenyou Yang | 2f7be64 | 2016-02-02 11:11:53 +0800 | [diff] [blame] | 23 | at91_usb_clk_init(AT91_PMC_USBS_USB_UPLL | AT91_PMC_USBDIV_10); |
Stelian Pop | e9fe2cf | 2008-11-09 00:14:46 +0100 | [diff] [blame] | 24 | #endif |
25 | |||||
Bo Shen | cf90563 | 2014-08-06 17:24:56 +0800 | [diff] [blame] | 26 | at91_periph_clk_enable(ATMEL_ID_UHP); |
Bo Shen | 72979a3 | 2013-05-12 22:40:53 +0000 | [diff] [blame] | 27 | |
Wenyou Yang | fbd4ac1 | 2016-02-03 10:16:51 +0800 | [diff] [blame] | 28 | at91_system_clk_enable(ATMEL_PMC_UHP); |
Bo Shen | bed082f | 2013-04-17 00:09:51 +0000 | [diff] [blame] | 29 | #if defined(CONFIG_AT91SAM9261) || defined(CONFIG_AT91SAM9G10) |
Wenyou Yang | fbd4ac1 | 2016-02-03 10:16:51 +0800 | [diff] [blame] | 30 | at91_system_clk_enable(AT91_PMC_HCK0); |
Stelian Pop | 61e69d7 | 2008-05-08 20:52:22 +0200 | [diff] [blame] | 31 | #endif |
Stelian Pop | d1aea1c | 2008-01-30 21:15:54 +0000 | [diff] [blame] | 32 | |
33 | return 0; | ||||
34 | } | ||||
35 | |||||
36 | int usb_cpu_stop(void) | ||||
37 | { | ||||
Bo Shen | cf90563 | 2014-08-06 17:24:56 +0800 | [diff] [blame] | 38 | at91_periph_clk_disable(ATMEL_ID_UHP); |
Bo Shen | 72979a3 | 2013-05-12 22:40:53 +0000 | [diff] [blame] | 39 | |
Wenyou Yang | fbd4ac1 | 2016-02-03 10:16:51 +0800 | [diff] [blame] | 40 | at91_system_clk_disable(ATMEL_PMC_UHP); |
Bo Shen | bed082f | 2013-04-17 00:09:51 +0000 | [diff] [blame] | 41 | #if defined(CONFIG_AT91SAM9261) || defined(CONFIG_AT91SAM9G10) |
Wenyou Yang | fbd4ac1 | 2016-02-03 10:16:51 +0800 | [diff] [blame] | 42 | at91_system_clk_disable(AT91_PMC_HCK0); |
Stelian Pop | 61e69d7 | 2008-05-08 20:52:22 +0200 | [diff] [blame] | 43 | #endif |
Stelian Pop | e9fe2cf | 2008-11-09 00:14:46 +0100 | [diff] [blame] | 44 | |
Bo Shen | 4a985df | 2013-10-21 16:14:00 +0800 | [diff] [blame] | 45 | #ifdef CONFIG_USB_ATMEL_CLK_SEL_PLLB |
Bo Shen | 8ed8783 | 2013-10-21 16:13:59 +0800 | [diff] [blame] | 46 | #ifdef CONFIG_AT91SAM9N12 |
Wenyou Yang | 2f7be64 | 2016-02-02 11:11:53 +0800 | [diff] [blame] | 47 | at91_usb_clk_init(0); |
Bo Shen | 8ed8783 | 2013-10-21 16:13:59 +0800 | [diff] [blame] | 48 | #endif |
Wenyou Yang | cb88cd8 | 2016-02-03 10:20:44 +0800 | [diff] [blame] | 49 | |
50 | if (at91_pllb_clk_disable()) | ||||
51 | return -1; | ||||
52 | |||||
Bo Shen | 4a985df | 2013-10-21 16:14:00 +0800 | [diff] [blame] | 53 | #elif defined(CONFIG_USB_ATMEL_CLK_SEL_UPLL) |
Wenyou Yang | 2f7be64 | 2016-02-02 11:11:53 +0800 | [diff] [blame] | 54 | if (at91_upll_clk_disable()) |
55 | return -1; | ||||
Stelian Pop | e9fe2cf | 2008-11-09 00:14:46 +0100 | [diff] [blame] | 56 | #endif |
57 | |||||
Stelian Pop | d1aea1c | 2008-01-30 21:15:54 +0000 | [diff] [blame] | 58 | return 0; |
59 | } | ||||
60 | |||||
61 | int usb_cpu_init_fail(void) | ||||
62 | { | ||||
63 | return usb_cpu_stop(); | ||||
64 | } |