| Anton Vorontsov | 5e41486 | 2008-05-23 20:38:56 +0400 | [diff] [blame^] | 1 | /* |
| 2 | * QE USB routines |
| 3 | * |
| 4 | * Copyright (c) Freescale Semicondutor, Inc. 2006. |
| 5 | * Shlomi Gridish <gridish@freescale.com> |
| 6 | * Jerry Huang <Chang-Ming.Huang@freescale.com> |
| 7 | * Copyright (c) MontaVista Software, Inc. 2008. |
| 8 | * Anton Vorontsov <avorontsov@ru.mvista.com> |
| 9 | * |
| 10 | * This program is free software; you can redistribute it and/or modify it |
| 11 | * under the terms of the GNU General Public License as published by the |
| 12 | * Free Software Foundation; either version 2 of the License, or (at your |
| 13 | * option) any later version. |
| 14 | */ |
| 15 | |
| 16 | #include <linux/kernel.h> |
| 17 | #include <linux/errno.h> |
| 18 | #include <linux/io.h> |
| 19 | #include <asm/immap_qe.h> |
| 20 | #include <asm/qe.h> |
| 21 | |
| 22 | int qe_usb_clock_set(enum qe_clock clk, int rate) |
| 23 | { |
| 24 | struct qe_mux __iomem *mux = &qe_immr->qmx; |
| 25 | unsigned long flags; |
| 26 | u32 val; |
| 27 | |
| 28 | switch (clk) { |
| 29 | case QE_CLK3: val = QE_CMXGCR_USBCS_CLK3; break; |
| 30 | case QE_CLK5: val = QE_CMXGCR_USBCS_CLK5; break; |
| 31 | case QE_CLK7: val = QE_CMXGCR_USBCS_CLK7; break; |
| 32 | case QE_CLK9: val = QE_CMXGCR_USBCS_CLK9; break; |
| 33 | case QE_CLK13: val = QE_CMXGCR_USBCS_CLK13; break; |
| 34 | case QE_CLK17: val = QE_CMXGCR_USBCS_CLK17; break; |
| 35 | case QE_CLK19: val = QE_CMXGCR_USBCS_CLK19; break; |
| 36 | case QE_CLK21: val = QE_CMXGCR_USBCS_CLK21; break; |
| 37 | case QE_BRG9: val = QE_CMXGCR_USBCS_BRG9; break; |
| 38 | case QE_BRG10: val = QE_CMXGCR_USBCS_BRG10; break; |
| 39 | default: |
| 40 | pr_err("%s: requested unknown clock %d\n", __func__, clk); |
| 41 | return -EINVAL; |
| 42 | } |
| 43 | |
| 44 | if (qe_clock_is_brg(clk)) |
| 45 | qe_setbrg(clk, rate, 1); |
| 46 | |
| 47 | spin_lock_irqsave(&cmxgcr_lock, flags); |
| 48 | |
| 49 | clrsetbits_be32(&mux->cmxgcr, QE_CMXGCR_USBCS, val); |
| 50 | |
| 51 | spin_unlock_irqrestore(&cmxgcr_lock, flags); |
| 52 | |
| 53 | return 0; |
| 54 | } |
| 55 | EXPORT_SYMBOL(qe_usb_clock_set); |