Fix how CPU load counts are adjusted so that the total always adds up to 100%

1 files changed, 8 insertions, 3 deletions

diff --git a/nuttx/sched/sched_cpuload.c b/nuttx/sched/sched_cpuload.c
index 802977f87..0f5495750 100644
--- a/nuttx/sched/sched_cpuload.c
+++ b/nuttx/sched/sched_cpuload.c
@@ -121,16 +121,21 @@ void weak_function sched_process_cpuload(void)
 
   if (++g_cpuload_total > (CONFIG_SCHED_CPULOAD_TIMECONSTANT * CLOCKS_PER_SEC))
     {
-      /* Divide the tick count for every task by two */
+      uint32_t total = 0;
+
+      /* Divide the tick count for every task by two and recalculate the
+       * total.
+       */
 
       for (i = 0; i < CONFIG_MAX_TASKS; i++)
         {
           g_pidhash[i].ticks >>= 1;
+          total += g_pidhash[i].ticks;
         }
 
-      /* Divide the total tick count by two */
+      /* Save the new total. */
 
-      g_cpuload_total  >>= 1;
+      g_cpuload_total = total;
     }
 }