1 /* Blackfin Phase Lock Loop (PLL) model.
3 Copyright (C) 2010-2021 Free Software Foundation, Inc.
4 Contributed by Analog Devices, Inc.
6 This file is part of simulators.
8 This program is free software; you can redistribute it and/or modify
9 it under the terms of the GNU General Public License as published by
10 the Free Software Foundation; either version 3 of the License, or
11 (at your option) any later version.
13 This program is distributed in the hope that it will be useful,
14 but WITHOUT ANY WARRANTY; without even the implied warranty of
15 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 GNU General Public License for more details.
18 You should have received a copy of the GNU General Public License
19 along with this program. If not, see <http://www.gnu.org/licenses/>. */
21 /* This must come before any other includes. */
27 #include "dv-bfin_pll.h"
33 /* Order after here is important -- matches hardware MMR layout. */
34 bu16
BFIN_MMR_16(pll_ctl
);
35 bu16
BFIN_MMR_16(pll_div
);
36 bu16
BFIN_MMR_16(vr_ctl
);
37 bu16
BFIN_MMR_16(pll_stat
);
38 bu16
BFIN_MMR_16(pll_lockcnt
);
40 /* XXX: Not really the best place for this ... */
43 #define mmr_base() offsetof(struct bfin_pll, pll_ctl)
44 #define mmr_offset(mmr) (offsetof(struct bfin_pll, mmr) - mmr_base())
46 static const char * const mmr_names
[] =
48 "PLL_CTL", "PLL_DIV", "VR_CTL", "PLL_STAT", "PLL_LOCKCNT", "CHIPID",
50 #define mmr_name(off) mmr_names[(off) / 4]
53 bfin_pll_io_write_buffer (struct hw
*me
, const void *source
,
54 int space
, address_word addr
, unsigned nr_bytes
)
56 struct bfin_pll
*pll
= hw_data (me
);
63 /* Invalid access mode is higher priority than missing register. */
64 if (!dv_bfin_mmr_require_16_32 (me
, addr
, nr_bytes
, true))
68 value
= dv_load_4 (source
);
70 value
= dv_load_2 (source
);
72 mmr_off
= addr
- pll
->base
;
73 valuep
= (void *)((unsigned long)pll
+ mmr_base() + mmr_off
);
81 case mmr_offset(pll_stat
):
82 if (!dv_bfin_mmr_require_16 (me
, addr
, nr_bytes
, true))
84 case mmr_offset(chipid
):
88 if (!dv_bfin_mmr_require_16 (me
, addr
, nr_bytes
, true))
98 bfin_pll_io_read_buffer (struct hw
*me
, void *dest
,
99 int space
, address_word addr
, unsigned nr_bytes
)
101 struct bfin_pll
*pll
= hw_data (me
);
107 /* Invalid access mode is higher priority than missing register. */
108 if (!dv_bfin_mmr_require_16_32 (me
, addr
, nr_bytes
, false))
111 mmr_off
= addr
- pll
->base
;
112 valuep
= (void *)((unsigned long)pll
+ mmr_base() + mmr_off
);
120 case mmr_offset(chipid
):
121 dv_store_4 (dest
, *value32p
);
124 if (!dv_bfin_mmr_require_16 (me
, addr
, nr_bytes
, false))
126 dv_store_2 (dest
, *value16p
);
133 static const struct hw_port_descriptor bfin_pll_ports
[] =
135 { "pll", 0, 0, output_port
, },
140 attach_bfin_pll_regs (struct hw
*me
, struct bfin_pll
*pll
)
142 address_word attach_address
;
144 unsigned attach_size
;
145 reg_property_spec reg
;
147 if (hw_find_property (me
, "reg") == NULL
)
148 hw_abort (me
, "Missing \"reg\" property");
150 if (!hw_find_reg_array_property (me
, "reg", 0, ®
))
151 hw_abort (me
, "\"reg\" property must contain three addr/size entries");
153 hw_unit_address_to_attach_address (hw_parent (me
),
155 &attach_space
, &attach_address
, me
);
156 hw_unit_size_to_attach_size (hw_parent (me
), ®
.size
, &attach_size
, me
);
158 if (attach_size
!= BFIN_MMR_PLL_SIZE
)
159 hw_abort (me
, "\"reg\" size must be %#x", BFIN_MMR_PLL_SIZE
);
161 hw_attach_address (hw_parent (me
),
162 0, attach_space
, attach_address
, attach_size
, me
);
164 pll
->base
= attach_address
;
168 bfin_pll_finish (struct hw
*me
)
170 struct bfin_pll
*pll
;
172 pll
= HW_ZALLOC (me
, struct bfin_pll
);
174 set_hw_data (me
, pll
);
175 set_hw_io_read_buffer (me
, bfin_pll_io_read_buffer
);
176 set_hw_io_write_buffer (me
, bfin_pll_io_write_buffer
);
177 set_hw_ports (me
, bfin_pll_ports
);
179 attach_bfin_pll_regs (me
, pll
);
181 /* Initialize the PLL. */
182 /* XXX: Depends on part ? */
183 pll
->pll_ctl
= 0x1400;
184 pll
->pll_div
= 0x0005;
185 pll
->vr_ctl
= 0x40DB;
186 pll
->pll_stat
= 0x00A2;
187 pll
->pll_lockcnt
= 0x0200;
188 pll
->chipid
= bfin_model_get_chipid (hw_system (me
));
190 /* XXX: slow it down! */
191 pll
->pll_ctl
= 0xa800;
193 pll
->vr_ctl
= 0x40fb;
194 pll
->pll_stat
= 0xa2;
195 pll
->pll_lockcnt
= 0x300;
198 const struct hw_descriptor dv_bfin_pll_descriptor
[] =
200 {"bfin_pll", bfin_pll_finish
,},