[2.5. PATCH] cpufreq: update HyperThreading support in p4-clockmod.c driver

[Dominik Brodowski]

--IJpNTDwzlM2Ie8A6
Content-Type: text/plain; charset=us-ascii
Content-Disposition: inline
Content-Transfer-Encoding: quoted-printable

[2.5. PATCH] cpufreq: update HyperThreading support in p4-clockmod.c driver

This patch updates the p4-clockmod.c driver to correctly manage
HyperThreading-enabled Pentium IVs as well as those models which do
not support HyperThreading - thanks to Venkatesh Pallipadi for
explaining cpu_sibling_map to me. Additionally, an EXPORT_SYMBOL=20
was missing. (spotted by Marc-Christian Petersen - thanks!)

	 Dominik

diff -ruN linux-2545original/arch/i386/kernel/cpu/cpufreq/p4-clockmod.c lin=
ux/arch/i386/kernel/cpu/cpufreq/p4-clockmod.c
--- linux-2545original/arch/i386/kernel/cpu/cpufreq/p4-clockmod.c	Fri Nov  =
1 21:12:23 2002
+++ linux/arch/i386/kernel/cpu/cpufreq/p4-clockmod.c	Sun Nov  3 12:30:34 20=
02
@@ -50,32 +50,55 @@
 MODULE_PARM(stock_freq, "i");
=20
 static struct cpufreq_driver *cpufreq_p4_driver;
-static unsigned int cpufreq_p4_old_state =3D 0;
=20
=20
 static int cpufreq_p4_setdc(unsigned int cpu, unsigned int newstate)
 {
 	u32 l, h;
 	unsigned long cpus_allowed;
-	struct cpufreq_freqs    freqs;
+	struct cpufreq_freqs freqs;
+	int hyperthreading =3D 0;
+	int affected_cpu_map =3D 0;
+	int sibling =3D 0;
=20
 	if (!cpu_online(cpu) || (newstate > DC_DISABLE) ||=20
 		(newstate =3D=3D DC_RESV))
 		return -EINVAL;
-	cpu =3D cpu >> 1; /* physical CPU #nr */
+
+	/* switch to physical CPU where state is to be changed*/
+	cpus_allowed =3D current->cpus_allowed;
+
+	/* only run on CPU to be set, or on its sibling */
+	affected_cpu_map =3D 1 << cpu;
+#ifdef CONFIG_X86_HT
+	hyperthreading =3D ((cpu_has_ht) && (smp_num_siblings =3D=3D 2));
+	if (hyperthreading) {
+		sibling =3D cpu_sibling_map[cpu];
+		affected_cpu_map |=3D (1 << sibling);
+	}
+#endif
+	set_cpus_allowed(current, affected_cpu_map);
+	BUG_ON(!(smp_processor_id() & affected_cpu_map));
+
+	/* get current state */
+	rdmsr(MSR_IA32_THERM_CONTROL, l, h);
+	l =3D l >> 1;
+	l &=3D 0x7;
+
+	if (l =3D=3D newstate) {
+		set_cpus_allowed(current, cpus_allowed);
+		return 0;
+	}
=20
 	/* notifiers */
-	freqs.old =3D stock_freq * cpufreq_p4_old_state / 8;
+	freqs.old =3D stock_freq * l / 8;
 	freqs.new =3D stock_freq * newstate / 8;
-	freqs.cpu =3D 2*cpu;
-	cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);
-	freqs.cpu++;
+	freqs.cpu =3D cpu;
 	cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);
-
-	/* switch to physical CPU where state is to be changed*/
-	cpus_allowed =3D current->cpus_allowed;
-	set_cpus_allowed(current, 3 << (2 * cpu));
-	BUG_ON(cpu !=3D (smp_processor_id() >> 1));
+	if (hyperthreading) {
+		freqs.cpu =3D sibling;
+		cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);
+	}
=20
 	rdmsr(MSR_IA32_THERM_STATUS, l, h);
 	if (l & 0x01)
@@ -86,10 +109,10 @@
=20
 	rdmsr(MSR_IA32_THERM_CONTROL, l, h);
 	if (newstate =3D=3D DC_DISABLE) {
-		printk(KERN_INFO PFX "CPU#%d,%d disabling modulation\n", cpu, (cpu + 1));
+		printk(KERN_INFO PFX "CPU#%d disabling modulation\n", cpu);
 		wrmsr(MSR_IA32_THERM_CONTROL, l & ~(1<<4), h);
 	} else {
-		printk(KERN_INFO PFX "CPU#%d,%d setting duty cycle to %d%%\n", cpu, (cpu=
 + 1), ((125 * newstate) / 10));
+		printk(KERN_INFO PFX "CPU#%d setting duty cycle to %d%%\n", cpu, ((125 *=
 newstate) / 10));
 		/* bits 63 - 5	: reserved=20
 		 * bit  4	: enable/disable
 		 * bits 3-1	: duty cycle
@@ -104,9 +127,10 @@
=20
 	/* notifiers */
 	cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);
-	freqs.cpu--;
-	cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);
-	cpufreq_p4_old_state =3D newstate;
+	if (hyperthreading) {
+		freqs.cpu =3D cpu;
+		cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);
+	}
=20
 	return 0;
 }
@@ -123,7 +147,7 @@
=20
 	if (policy->policy =3D=3D CPUFREQ_POLICY_POWERSAVE)
 	{
-		for (i=3D8; i>0; i++)
+		for (i=3D8; i>0; i--)
 			if ((policy->min <=3D ((stock_freq / 8) * i)) &&
 			    (policy->max >=3D ((stock_freq / 8) * i)))=20
 			{
@@ -131,7 +155,7 @@
 				number_states++;
 			}
 	} else {
-		for (i=3D0; i<=3D8; i--)
+		for (i=3D1; i<=3D8; i++)
 			if ((policy->min <=3D ((stock_freq / 8) * i)) &&
 			    (policy->max >=3D ((stock_freq / 8) * i)))=20
 			{
@@ -143,9 +167,9 @@
 	/* if (number_states =3D=3D 1) */
 	{
 		if (policy->cpu =3D=3D CPUFREQ_ALL_CPUS) {
-			for (i=3D0; i<(NR_CPUS/2); i++)
-				if (cpu_online(2*i))
-					cpufreq_p4_setdc((2*i), newstate);
+			for (i=3D0; i<NR_CPUS; i++)
+				if (cpu_online(i))
+					cpufreq_p4_setdc(i, newstate);
 		} else {
 			cpufreq_p4_setdc(policy->cpu, newstate);
 		}
@@ -235,7 +259,6 @@
 	for (i=3D0;i<NR_CPUS;i++)
 		driver->cpu_cur_freq[i] =3D stock_freq;
 #endif
-	cpufreq_p4_old_state  =3D DC_DISABLE;
=20
 	driver->verify        =3D &cpufreq_p4_verify;
 	driver->setpolicy     =3D &cpufreq_p4_setpolicy;
diff -ruN linux-2545original/arch/i386/kernel/i386_ksyms.c linux/arch/i386/=
kernel/i386_ksyms.c
--- linux-2545original/arch/i386/kernel/i386_ksyms.c	Fri Nov  1 21:12:23 20=
02
+++ linux/arch/i386/kernel/i386_ksyms.c	Fri Nov  1 21:08:44 2002
@@ -143,6 +143,11 @@
 EXPORT_SYMBOL(mmx_copy_page);
 #endif
=20
+#ifdef CONFIG_X86_HT
+EXPORT_SYMBOL(smp_num_siblings);
+EXPORT_SYMBOL(cpu_sibling_map);
+#endif
+
 #ifdef CONFIG_SMP
 EXPORT_SYMBOL(cpu_data);
 EXPORT_SYMBOL(cpu_online_map);

--IJpNTDwzlM2Ie8A6
Content-Type: application/pgp-signature
Content-Disposition: inline

-----BEGIN PGP SIGNATURE-----
Version: GnuPG v1.0.6 (GNU/Linux)
Comment: Weitere Infos: siehe http://www.gnupg.org

iD8DBQE9xROcZ8MDCHJbN8YRAu49AJwKxd/Mx0J1JNi/PTZduwVtI/YafgCfbk8k
pmvtIlBU+7arCcCbnkHz8Q8=
=ytNY
-----END PGP SIGNATURE-----

--IJpNTDwzlM2Ie8A6--