| /* Copyright 2018 SiFive, Inc */ |
| /* SPDX-License-Identifier: Apache-2.0 */ |
| |
| #include <metal/machine/platform.h> |
| |
| #ifdef METAL_SIFIVE_FU540_C000_L2 |
| |
| #include <stdint.h> |
| #include <metal/io.h> |
| #include <metal/drivers/sifive_fu540-c000_l2.h> |
| #include <metal/machine.h> |
| |
| #define L2_CONFIG_WAYS_SHIFT 8 |
| #define L2_CONFIG_WAYS_MASK (0xFF << L2_CONFIG_WAYS_SHIFT) |
| |
| void __metal_driver_sifive_fu540_c000_l2_init(struct metal_cache *l2, int ways); |
| |
| static void metal_driver_sifive_fu540_c000_l2_init(void) __attribute__((constructor)); |
| static void metal_driver_sifive_fu540_c000_l2_init(void) |
| { |
| #ifdef __METAL_DT_SIFIVE_FU540_C000_L2_HANDLE |
| /* Get the handle for the L2 cache controller */ |
| struct metal_cache *l2 = __METAL_DT_SIFIVE_FU540_C000_L2_HANDLE; |
| if(!l2) { |
| return; |
| } |
| |
| /* Get the number of available ways per bank */ |
| unsigned long control_base = __metal_driver_sifive_fu540_c000_l2_control_base(l2); |
| uint32_t ways = __METAL_ACCESS_ONCE((__metal_io_u32 *)(control_base + METAL_SIFIVE_FU540_C000_L2_CONFIG)); |
| ways = ((ways & L2_CONFIG_WAYS_MASK) >> L2_CONFIG_WAYS_SHIFT); |
| |
| /* Enable all the ways */ |
| __metal_driver_sifive_fu540_c000_l2_init(l2, ways); |
| #endif |
| } |
| |
| void __metal_driver_sifive_fu540_c000_l2_init(struct metal_cache *l2, int ways) |
| { |
| metal_cache_set_enabled_ways(l2, ways); |
| } |
| |
| int __metal_driver_sifive_fu540_c000_l2_get_enabled_ways(struct metal_cache *cache) |
| { |
| unsigned long control_base = __metal_driver_sifive_fu540_c000_l2_control_base(cache); |
| |
| uint32_t way_enable = __METAL_ACCESS_ONCE((__metal_io_u32 *)(control_base + METAL_SIFIVE_FU540_C000_L2_WAYENABLE)); |
| |
| /* The stored number is the index, so add one */ |
| return (0xFF & way_enable) + 1; |
| } |
| |
| int __metal_driver_sifive_fu540_c000_l2_set_enabled_ways(struct metal_cache *cache, int ways) |
| { |
| unsigned long control_base = __metal_driver_sifive_fu540_c000_l2_control_base(cache); |
| |
| /* We can't decrease the number of enabled ways */ |
| if(metal_cache_get_enabled_ways(cache) > ways) { |
| return -2; |
| } |
| |
| /* The stored value is the index, so subtract one */ |
| uint32_t value = 0xFF & (ways - 1); |
| |
| /* Set the number of enabled ways */ |
| __METAL_ACCESS_ONCE((__metal_io_u32 *)(control_base + METAL_SIFIVE_FU540_C000_L2_WAYENABLE)) = value; |
| |
| /* Make sure the number of ways was set correctly */ |
| if(metal_cache_get_enabled_ways(cache) != ways) { |
| return -3; |
| } |
| |
| return 0; |
| } |
| |
| __METAL_DEFINE_VTABLE(__metal_driver_vtable_sifive_fu540_c000_l2) = { |
| .cache.init = __metal_driver_sifive_fu540_c000_l2_init, |
| .cache.get_enabled_ways = __metal_driver_sifive_fu540_c000_l2_get_enabled_ways, |
| .cache.set_enabled_ways = __metal_driver_sifive_fu540_c000_l2_set_enabled_ways, |
| }; |
| |
| #endif |
| |
| typedef int no_empty_translation_units; |