--- zzzz-none-000/linux-4.9.231/drivers/clocksource/mips-gic-timer.c	2020-07-22 07:10:54.000000000 +0000
+++ falcon-5590-729/linux-4.9.231/drivers/clocksource/mips-gic-timer.c	2022-03-30 12:03:34.000000000 +0000
@@ -8,6 +8,7 @@
 #include <linux/clk.h>
 #include <linux/clockchips.h>
 #include <linux/cpu.h>
+#include <linux/cpufreq.h>
 #include <linux/init.h>
 #include <linux/interrupt.h>
 #include <linux/irqchip/mips-gic.h>
@@ -16,6 +17,8 @@
 #include <linux/percpu.h>
 #include <linux/smp.h>
 #include <linux/time.h>
+#include <linux/timekeeping.h>
+#include <linux/sched_clock.h>
 
 static DEFINE_PER_CPU(struct clock_event_device, gic_clockevent_device);
 static int gic_timer_irq;
@@ -61,7 +64,7 @@
 	cd->cpumask		= cpumask_of(cpu);
 	cd->set_next_event	= gic_next_event;
 
-	clockevents_config_and_register(cd, gic_frequency, 0x300, 0x7fffffff);
+	clockevents_config_and_register(cd, gic_frequency, 0x3000, 0x7fffffff);
 
 	enable_percpu_irq(gic_timer_irq, IRQ_TYPE_NONE);
 }
@@ -137,6 +140,11 @@
 	.archdata	= { .vdso_clock_mode = VDSO_CLOCK_GIC },
 };
 
+static u64 notrace gic_read_sched_clock(void)
+{
+	return gic_read_count();
+}
+
 static int __init __gic_clocksource_init(void)
 {
 	int ret;
@@ -150,6 +158,8 @@
 	ret = clocksource_register_hz(&gic_clocksource, gic_frequency);
 	if (ret < 0)
 		pr_warn("GIC: Unable to register clocksource\n");
+	sched_clock_register(gic_read_sched_clock, gic_get_count_width(),
+			     gic_frequency);
 
 	return ret;
 }
@@ -215,3 +225,31 @@
 }
 CLOCKSOURCE_OF_DECLARE(mips_gic_timer, "mti,gic-timer",
 		       gic_clocksource_of_init);
+static int
+gic_cpufreq_notifier(struct notifier_block *nb, unsigned long event, void *data)
+{
+	struct cpufreq_freqs *freq = data;
+
+	if (event == CPUFREQ_POSTCHANGE) {
+		if (gic_frequency == freq->new * 1000)
+			return 0;
+
+		gic_frequency = freq->new * 1000;
+		__clocksource_update_freq_hz(&gic_clocksource, gic_frequency);
+		on_each_cpu(gic_update_frequency, (void *)gic_frequency, 1);
+		timekeeping_notify(&gic_clocksource);
+	}
+
+	return 0;
+}
+
+static struct notifier_block gic_cpufreq_nb = {
+	.notifier_call = gic_cpufreq_notifier,
+};
+
+static int __init cpufreq_register_gic_scaling(void)
+{
+	cpufreq_register_notifier(&gic_cpufreq_nb, CPUFREQ_TRANSITION_NOTIFIER);
+	return 0;
+}
+device_initcall(cpufreq_register_gic_scaling);