blob: 14ce2fae6d7b238f523b834307ea7b2dd76ae42f (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
|
/* Copyright 2018 SiFive, Inc */
/* SPDX-License-Identifier: Apache-2.0 */
#include <metal/machine/platform.h>
#ifdef METAL_SIFIVE_FE310_G000_HFROSC
#include <metal/drivers/sifive_fe310-g000_hfrosc.h>
#include <metal/machine.h>
#define CONFIG_DIVIDER 0x0000003FUL
#define CONFIG_TRIM 0x001F0000UL
#define CONFIG_ENABLE 0x40000000UL
#define CONFIG_READY 0x80000000UL
long __metal_driver_sifive_fe310_g000_hfrosc_get_rate_hz(const struct metal_clock *clock)
{
struct metal_clock *ref = __metal_driver_sifive_fe310_g000_hfrosc_ref(clock);
long config_offset = __metal_driver_sifive_fe310_g000_hfrosc_config_offset(clock);
struct __metal_driver_sifive_fe310_g000_prci *config_base =
__metal_driver_sifive_fe310_g000_hfrosc_config_base(clock);
const struct __metal_driver_vtable_sifive_fe310_g000_prci *vtable =
__metal_driver_sifive_fe310_g000_prci_vtable();
long cfg = vtable->get_reg(config_base, config_offset);
if (cfg & CONFIG_ENABLE == 0)
return -1;
if (cfg & CONFIG_READY == 0)
return -1;
return metal_clock_get_rate_hz(ref) / ((cfg & CONFIG_DIVIDER) + 1);
}
long __metal_driver_sifive_fe310_g000_hfrosc_set_rate_hz(struct metal_clock *clock, long rate)
{
return __metal_driver_sifive_fe310_g000_hfrosc_get_rate_hz(clock);
}
__METAL_DEFINE_VTABLE(__metal_driver_vtable_sifive_fe310_g000_hfrosc) = {
.clock.get_rate_hz = &__metal_driver_sifive_fe310_g000_hfrosc_get_rate_hz,
.clock.set_rate_hz = &__metal_driver_sifive_fe310_g000_hfrosc_set_rate_hz,
};
#endif /* METAL_SIFIVE_FE310_G000_HFROSC */
|