git.sur5r.net Git - freertos/blob

   1 /* Copyright 2018 SiFive, Inc */
   2 /* SPDX-License-Identifier: Apache-2.0 */
   3
   4 #include <metal/machine/platform.h>
   5
   6 #ifdef METAL_SIFIVE_FE310_G000_HFXOSC
   7
   8 #include <metal/drivers/sifive_fe310-g000_hfxosc.h>
   9 #include <metal/machine.h>
  10
  11 #define CONFIG_ENABLE  0x40000000UL
  12 #define CONFIG_READY   0x80000000UL
  13
  14 long __metal_driver_sifive_fe310_g000_hfxosc_get_rate_hz(const struct metal_clock *clock)
  15 {
  16     struct metal_clock *ref = __metal_driver_sifive_fe310_g000_hfxosc_ref(clock);
  17     long config_offset = __metal_driver_sifive_fe310_g000_hfxosc_config_offset(clock);
  18     struct __metal_driver_sifive_fe310_g000_prci *config_base =
  19       __metal_driver_sifive_fe310_g000_hfxosc_config_base(clock);
  20     const struct __metal_driver_vtable_sifive_fe310_g000_prci *vtable =
  21       __metal_driver_sifive_fe310_g000_prci_vtable();
  22     long cfg = vtable->get_reg(config_base, config_offset);
  23
  24     if (cfg & CONFIG_ENABLE == 0)
  25         return -1;
  26     if (cfg & CONFIG_READY == 0)
  27         return -1;
  28     return metal_clock_get_rate_hz(ref);
  29 }
  30
  31 long __metal_driver_sifive_fe310_g000_hfxosc_set_rate_hz(struct metal_clock *clock, long rate)
  32 {
  33     return __metal_driver_sifive_fe310_g000_hfxosc_get_rate_hz(clock);
  34 }
  35
  36 __METAL_DEFINE_VTABLE(__metal_driver_vtable_sifive_fe310_g000_hfxosc) = {
  37     .clock.get_rate_hz = __metal_driver_sifive_fe310_g000_hfxosc_get_rate_hz,
  38     .clock.set_rate_hz = __metal_driver_sifive_fe310_g000_hfxosc_set_rate_hz,
  39 };
  40
  41 #endif /* METAL_SIFIVE_FE310_G000_HFXOSC */