| 1 | /* |
|---|
| 2 | * core.c - core descriptor access function. |
|---|
| 3 | * |
|---|
| 4 | * Author Ghassan Almaless (2008,2009,2010,2011,2012) |
|---|
| 5 | * Alain Greiner (2016,2017) |
|---|
| 6 | * |
|---|
| 7 | * Copyright (c) UPMC Sorbonne Universites |
|---|
| 8 | * |
|---|
| 9 | * This file is part of ALMOS-MKH. |
|---|
| 10 | * |
|---|
| 11 | * ALMOS-MKH.is free software; you can redistribute it and/or modify it |
|---|
| 12 | * under the terms of the GNU General Public License as published by |
|---|
| 13 | * the Free Software Foundation; version 2.0 of the License. |
|---|
| 14 | * |
|---|
| 15 | * ALMOS-MKH is distributed in the hope that it will be useful, but |
|---|
| 16 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
|---|
| 17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
|---|
| 18 | * General Public License for more details. |
|---|
| 19 | * |
|---|
| 20 | * You should have received a copy of the GNU General Public License |
|---|
| 21 | * along with ALMOS-MKH; if not, write to the Free Software Foundation, |
|---|
| 22 | * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
|---|
| 23 | */ |
|---|
| 24 | |
|---|
| 25 | #include <kernel_config.h> |
|---|
| 26 | #include <hal_types.h> |
|---|
| 27 | #include <hal_special.h> |
|---|
| 28 | #include <errno.h> |
|---|
| 29 | #include <printk.h> |
|---|
| 30 | #include <thread.h> |
|---|
| 31 | #include <chdev.h> |
|---|
| 32 | #include <dev_pic.h> |
|---|
| 33 | #include <rpc.h> |
|---|
| 34 | #include <cluster.h> |
|---|
| 35 | #include <kmem.h> |
|---|
| 36 | #include <dqdt.h> |
|---|
| 37 | #include <core.h> |
|---|
| 38 | |
|---|
| 39 | ///////////////////////////////// |
|---|
| 40 | void core_init( core_t * core, |
|---|
| 41 | lid_t lid, |
|---|
| 42 | gid_t gid ) |
|---|
| 43 | { |
|---|
| 44 | core->lid = lid; |
|---|
| 45 | core->gid = gid; |
|---|
| 46 | core->cycles = 0; |
|---|
| 47 | core->time_stamp = 0; |
|---|
| 48 | core->ticks_nr = 0; |
|---|
| 49 | core->usage = 0; |
|---|
| 50 | core->spurious_irqs = 0; |
|---|
| 51 | core->thread_idle = NULL; |
|---|
| 52 | core->fpu_owner = NULL; |
|---|
| 53 | core->rand_last = hal_time_stamp() & 0xFFF; |
|---|
| 54 | |
|---|
| 55 | // initialize scheduler |
|---|
| 56 | sched_init( core ); |
|---|
| 57 | } |
|---|
| 58 | |
|---|
| 59 | ////////////////////////////////////////////// |
|---|
| 60 | inline uint32_t core_get_rand( core_t * core ) |
|---|
| 61 | { |
|---|
| 62 | uint32_t value = ((core->rand_last * CONFIG_RDNG_PARAM_A) + |
|---|
| 63 | CONFIG_RDNG_PARAM_C) ^ (hal_get_cycles() & 0xFFF); |
|---|
| 64 | core->rand_last = value; |
|---|
| 65 | return value; |
|---|
| 66 | } |
|---|
| 67 | |
|---|
| 68 | //////////////////////////////////// |
|---|
| 69 | void core_get_time( core_t * core, |
|---|
| 70 | uint32_t * tm_s, |
|---|
| 71 | uint32_t * tm_us ) |
|---|
| 72 | { |
|---|
| 73 | *tm_s = (core->ticks_nr*CONFIG_SCHED_TICK_PERIOD)/1000; |
|---|
| 74 | *tm_us = (core->ticks_nr*CONFIG_SCHED_TICK_PERIOD*1000)%1000000; |
|---|
| 75 | } |
|---|
| 76 | |
|---|
| 77 | /* deprecated 14/08/2017 [AG] |
|---|
| 78 | ////////////////////////////////////// |
|---|
| 79 | void core_time_update( core_t * core ) |
|---|
| 80 | { |
|---|
| 81 | uint32_t elapsed; |
|---|
| 82 | uint32_t ticks_nr = core->ticks_nr; |
|---|
| 83 | uint64_t cycles = core->cycles; |
|---|
| 84 | uint32_t time_stamp = core->time_stamp; |
|---|
| 85 | uint32_t time_now = hal_get_cycles(); |
|---|
| 86 | |
|---|
| 87 | // compute number of elapsed cycles taking into account 32 bits register wrap |
|---|
| 88 | if( time_now < time_stamp ) elapsed = (0xFFFFFFFF - time_stamp) + time_now; |
|---|
| 89 | else elapsed = time_now - time_stamp; |
|---|
| 90 | |
|---|
| 91 | cycles += elapsed; |
|---|
| 92 | ticks_nr = elapsed / core->ticks_period; |
|---|
| 93 | |
|---|
| 94 | core->time_stamp = time_now; |
|---|
| 95 | core->cycles = cycles + elapsed; |
|---|
| 96 | core->ticks_nr = ticks_nr + (elapsed / core->ticks_period); |
|---|
| 97 | hal_fence(); |
|---|
| 98 | } |
|---|
| 99 | */ |
|---|
| 100 | |
|---|
| 101 | //////////////////////////////// |
|---|
| 102 | void core_clock( core_t * core ) |
|---|
| 103 | { |
|---|
| 104 | uint32_t ticks; |
|---|
| 105 | |
|---|
| 106 | // update ticks counter |
|---|
| 107 | ticks = core->ticks_nr++; |
|---|
| 108 | |
|---|
| 109 | // handle pending alarms TODO ??? [AG] |
|---|
| 110 | // alarm_clock( &core->alarm_mgr , ticks ); |
|---|
| 111 | |
|---|
| 112 | // handle scheduler |
|---|
| 113 | if( (ticks % CONFIG_SCHED_TICKS_PER_QUANTUM) == 0 ) sched_yield( NULL ); |
|---|
| 114 | |
|---|
| 115 | // update DQDT TODO This update should depend on the cluster identifier, |
|---|
| 116 | // to avoid simultaneous updates from various clusters ... AG |
|---|
| 117 | if( ((ticks % CONFIG_DQDT_TICKS_PER_QUANTUM) == 0) && (core->lid == 0) ) |
|---|
| 118 | dqdt_global_update(); |
|---|
| 119 | } |
|---|
| 120 | |
|---|
| 121 | //////////////////////////////////////// |
|---|
| 122 | void core_compute_stats( core_t * core ) |
|---|
| 123 | { |
|---|
| 124 | thread_t * idle = core->thread_idle; |
|---|
| 125 | uint32_t ticks = core->ticks_nr; |
|---|
| 126 | |
|---|
| 127 | uint32_t idle_percent; |
|---|
| 128 | uint32_t busy_percent; |
|---|
| 129 | uint32_t usage; |
|---|
| 130 | |
|---|
| 131 | // compute cumulated usage |
|---|
| 132 | ticks = (ticks) ? ticks : 1; |
|---|
| 133 | idle_percent = (idle->ticks_nr * 100) / ticks; |
|---|
| 134 | idle_percent = (idle_percent > 100) ? 100 : idle_percent; |
|---|
| 135 | busy_percent = 100 - idle_percent; |
|---|
| 136 | usage = (busy_percent + core->usage) / 2; |
|---|
| 137 | |
|---|
| 138 | // update core descriptor |
|---|
| 139 | core->usage = usage; |
|---|
| 140 | hal_fence(); |
|---|
| 141 | |
|---|
| 142 | #if CONFIG_SHOW_CPU_USAGE |
|---|
| 143 | printk(INFO, "INFO: core %d in cluster %x : busy_percent = %d / cumulated_usage = %d\n", |
|---|
| 144 | core->lid, local_cxy , busy_percent , usage ); |
|---|
| 145 | #endif |
|---|
| 146 | |
|---|
| 147 | core->ticks_nr = 0; |
|---|
| 148 | idle->ticks_nr = 0; |
|---|
| 149 | } |
|---|
| 150 | |
|---|
| 151 | ///////////////////////////////////// |
|---|
| 152 | void core_reset_stats( core_t * core ) |
|---|
| 153 | { |
|---|
| 154 | core->ticks_nr = 0; |
|---|
| 155 | core->usage = 0; |
|---|
| 156 | core->thread_idle->ticks_nr = 0; |
|---|
| 157 | hal_fence(); |
|---|
| 158 | } |
|---|
| 159 | |
|---|
| 160 | |
|---|
| 161 | /* deprecated [AG] july 20017 |
|---|
| 162 | /////////////////////////////////////////////////// |
|---|
| 163 | void core_set_irq_vector_entry( core_t * core, |
|---|
| 164 | uint32_t irq_type, |
|---|
| 165 | uint32_t irq_id, |
|---|
| 166 | chdev_t * chdev ) |
|---|
| 167 | { |
|---|
| 168 | if ( irq_type == WTI_TYPE ) core->wti_vector[irq_id] = chdev; |
|---|
| 169 | else if( irq_type == HWI_TYPE ) core->hwi_vector[irq_id] = chdev; |
|---|
| 170 | else core->pti_vector[irq_id] = chdev; |
|---|
| 171 | } |
|---|
| 172 | */ |
|---|