paul@211 | 1 | /* |
paul@211 | 2 | * Common clock and power management functionality. |
paul@211 | 3 | * |
paul@211 | 4 | * Copyright (C) 2023 Paul Boddie <paul@boddie.org.uk> |
paul@211 | 5 | * |
paul@211 | 6 | * This program is free software; you can redistribute it and/or |
paul@211 | 7 | * modify it under the terms of the GNU General Public License as |
paul@211 | 8 | * published by the Free Software Foundation; either version 2 of |
paul@211 | 9 | * the License, or (at your option) any later version. |
paul@211 | 10 | * |
paul@211 | 11 | * This program is distributed in the hope that it will be useful, |
paul@211 | 12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
paul@211 | 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
paul@211 | 14 | * GNU General Public License for more details. |
paul@211 | 15 | * |
paul@211 | 16 | * You should have received a copy of the GNU General Public License |
paul@211 | 17 | * along with this program; if not, write to the Free Software |
paul@211 | 18 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, |
paul@211 | 19 | * Boston, MA 02110-1301, USA |
paul@211 | 20 | */ |
paul@211 | 21 | |
paul@211 | 22 | #include "cpm.h" |
paul@211 | 23 | #include "cpm-common.h" |
paul@211 | 24 | |
paul@211 | 25 | |
paul@211 | 26 | |
paul@211 | 27 | Cpm_chip::Cpm_chip(l4_addr_t addr, Clock_base *clocks[]) |
paul@211 | 28 | : _clocks(clocks), _cpm_regs(addr, clocks) |
paul@211 | 29 | { |
paul@211 | 30 | } |
paul@211 | 31 | |
paul@211 | 32 | const char * |
paul@211 | 33 | Cpm_chip::clock_type(enum Clock_identifiers clock) |
paul@211 | 34 | { |
paul@211 | 35 | return _clocks[clock]->clock_type(); |
paul@211 | 36 | } |
paul@211 | 37 | |
paul@211 | 38 | int |
paul@211 | 39 | Cpm_chip::have_clock(enum Clock_identifiers clock) |
paul@211 | 40 | { |
paul@211 | 41 | return _clocks[clock]->have_clock(_cpm_regs); |
paul@211 | 42 | } |
paul@211 | 43 | |
paul@211 | 44 | void |
paul@211 | 45 | Cpm_chip::start_clock(enum Clock_identifiers clock) |
paul@211 | 46 | { |
paul@211 | 47 | _clocks[clock]->start_clock(_cpm_regs); |
paul@211 | 48 | } |
paul@211 | 49 | |
paul@211 | 50 | void |
paul@211 | 51 | Cpm_chip::stop_clock(enum Clock_identifiers clock) |
paul@211 | 52 | { |
paul@211 | 53 | _clocks[clock]->stop_clock(_cpm_regs); |
paul@211 | 54 | } |
paul@211 | 55 | |
paul@211 | 56 | int |
paul@211 | 57 | Cpm_chip::get_parameters(enum Clock_identifiers clock, uint32_t parameters[]) |
paul@211 | 58 | { |
paul@211 | 59 | Clock_divided_base *clk = dynamic_cast<Clock_divided_base *>(_clocks[clock]); |
paul@211 | 60 | |
paul@211 | 61 | if (clk != NULL) |
paul@211 | 62 | return clk->get_parameters(_cpm_regs, parameters); |
paul@211 | 63 | else |
paul@211 | 64 | return 0; |
paul@211 | 65 | } |
paul@211 | 66 | |
paul@211 | 67 | int |
paul@211 | 68 | Cpm_chip::set_parameters(enum Clock_identifiers clock, int num_parameters, uint32_t parameters[]) |
paul@211 | 69 | { |
paul@211 | 70 | Clock_divided_base *clk = dynamic_cast<Clock_divided_base *>(_clocks[clock]); |
paul@211 | 71 | |
paul@211 | 72 | if (clk != NULL) |
paul@211 | 73 | return clk->set_parameters(_cpm_regs, num_parameters, parameters); |
paul@211 | 74 | else |
paul@211 | 75 | return 0; |
paul@211 | 76 | } |
paul@211 | 77 | |
paul@211 | 78 | uint8_t |
paul@211 | 79 | Cpm_chip::get_source(enum Clock_identifiers clock) |
paul@211 | 80 | { |
paul@211 | 81 | Clock_active *clk = dynamic_cast<Clock_active *>(_clocks[clock]); |
paul@211 | 82 | |
paul@211 | 83 | if (clk != NULL) |
paul@211 | 84 | return clk->get_source(_cpm_regs); |
paul@211 | 85 | else |
paul@211 | 86 | return 0; |
paul@211 | 87 | } |
paul@211 | 88 | |
paul@211 | 89 | enum Clock_identifiers |
paul@211 | 90 | Cpm_chip::get_source_clock(enum Clock_identifiers clock) |
paul@211 | 91 | { |
paul@211 | 92 | Clock_active *clk = dynamic_cast<Clock_active *>(_clocks[clock]); |
paul@211 | 93 | |
paul@211 | 94 | if (clk != NULL) |
paul@211 | 95 | return clk->get_source_clock(_cpm_regs); |
paul@211 | 96 | else |
paul@211 | 97 | return Clock_undefined; |
paul@211 | 98 | } |
paul@211 | 99 | |
paul@211 | 100 | void |
paul@211 | 101 | Cpm_chip::set_source_clock(enum Clock_identifiers clock, enum Clock_identifiers source) |
paul@211 | 102 | { |
paul@211 | 103 | Clock_active *clk = dynamic_cast<Clock_active *>(_clocks[clock]); |
paul@211 | 104 | |
paul@211 | 105 | if (clk != NULL) |
paul@211 | 106 | clk->set_source_clock(_cpm_regs, source); |
paul@211 | 107 | } |
paul@211 | 108 | |
paul@211 | 109 | void |
paul@211 | 110 | Cpm_chip::set_source(enum Clock_identifiers clock, uint8_t source) |
paul@211 | 111 | { |
paul@211 | 112 | Clock_active *clk = dynamic_cast<Clock_active *>(_clocks[clock]); |
paul@211 | 113 | |
paul@211 | 114 | if (clk != NULL) |
paul@211 | 115 | clk->set_source(_cpm_regs, source); |
paul@211 | 116 | } |
paul@211 | 117 | |
paul@219 | 118 | uint64_t |
paul@211 | 119 | Cpm_chip::get_source_frequency(enum Clock_identifiers clock) |
paul@211 | 120 | { |
paul@211 | 121 | Clock_active *clk = dynamic_cast<Clock_active *>(_clocks[clock]); |
paul@211 | 122 | |
paul@211 | 123 | if (clk != NULL) |
paul@211 | 124 | return clk->get_source_frequency(_cpm_regs); |
paul@211 | 125 | else |
paul@211 | 126 | return 0; |
paul@211 | 127 | } |
paul@211 | 128 | |
paul@219 | 129 | uint64_t |
paul@211 | 130 | Cpm_chip::get_frequency(enum Clock_identifiers clock) |
paul@211 | 131 | { |
paul@211 | 132 | return _clocks[clock]->get_frequency(_cpm_regs); |
paul@211 | 133 | } |
paul@211 | 134 | |
paul@211 | 135 | int |
paul@219 | 136 | Cpm_chip::set_frequency(enum Clock_identifiers clock, uint64_t frequency) |
paul@211 | 137 | { |
paul@211 | 138 | Clock_divided_base *clk = dynamic_cast<Clock_divided_base *>(_clocks[clock]); |
paul@211 | 139 | |
paul@211 | 140 | if (clk != NULL) |
paul@211 | 141 | return clk->set_frequency(_cpm_regs, frequency); |
paul@211 | 142 | else |
paul@211 | 143 | return 0; |
paul@211 | 144 | } |