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