18c2ecf20Sopenharmony_ci/**
28c2ecf20Sopenharmony_ci * @file arch/alpha/oprofile/op_model_ev5.c
38c2ecf20Sopenharmony_ci *
48c2ecf20Sopenharmony_ci * @remark Copyright 2002 OProfile authors
58c2ecf20Sopenharmony_ci * @remark Read the file COPYING
68c2ecf20Sopenharmony_ci *
78c2ecf20Sopenharmony_ci * @author Richard Henderson <rth@twiddle.net>
88c2ecf20Sopenharmony_ci */
98c2ecf20Sopenharmony_ci
108c2ecf20Sopenharmony_ci#include <linux/oprofile.h>
118c2ecf20Sopenharmony_ci#include <linux/smp.h>
128c2ecf20Sopenharmony_ci#include <asm/ptrace.h>
138c2ecf20Sopenharmony_ci
148c2ecf20Sopenharmony_ci#include "op_impl.h"
158c2ecf20Sopenharmony_ci
168c2ecf20Sopenharmony_ci
178c2ecf20Sopenharmony_ci/* Compute all of the registers in preparation for enabling profiling.
188c2ecf20Sopenharmony_ci
198c2ecf20Sopenharmony_ci   The 21164 (EV5) and 21164PC (PCA65) vary in the bit placement and
208c2ecf20Sopenharmony_ci   meaning of the "CBOX" events.  Given that we don't care about meaning
218c2ecf20Sopenharmony_ci   at this point, arrange for the difference in bit placement to be
228c2ecf20Sopenharmony_ci   handled by common code.  */
238c2ecf20Sopenharmony_ci
248c2ecf20Sopenharmony_cistatic void
258c2ecf20Sopenharmony_cicommon_reg_setup(struct op_register_config *reg,
268c2ecf20Sopenharmony_ci		 struct op_counter_config *ctr,
278c2ecf20Sopenharmony_ci		 struct op_system_config *sys,
288c2ecf20Sopenharmony_ci		 int cbox1_ofs, int cbox2_ofs)
298c2ecf20Sopenharmony_ci{
308c2ecf20Sopenharmony_ci	int i, ctl, reset, need_reset;
318c2ecf20Sopenharmony_ci
328c2ecf20Sopenharmony_ci	/* Select desired events.  The event numbers are selected such
338c2ecf20Sopenharmony_ci	   that they map directly into the event selection fields:
348c2ecf20Sopenharmony_ci
358c2ecf20Sopenharmony_ci		PCSEL0:	0, 1
368c2ecf20Sopenharmony_ci		PCSEL1:	24-39
378c2ecf20Sopenharmony_ci		 CBOX1: 40-47
388c2ecf20Sopenharmony_ci		PCSEL2: 48-63
398c2ecf20Sopenharmony_ci		 CBOX2: 64-71
408c2ecf20Sopenharmony_ci
418c2ecf20Sopenharmony_ci	   There are two special cases, in that CYCLES can be measured
428c2ecf20Sopenharmony_ci	   on PCSEL[02], and SCACHE_WRITE can be measured on CBOX[12].
438c2ecf20Sopenharmony_ci	   These event numbers are canonicalizes to their first appearance.  */
448c2ecf20Sopenharmony_ci
458c2ecf20Sopenharmony_ci	ctl = 0;
468c2ecf20Sopenharmony_ci	for (i = 0; i < 3; ++i) {
478c2ecf20Sopenharmony_ci		unsigned long event = ctr[i].event;
488c2ecf20Sopenharmony_ci		if (!ctr[i].enabled)
498c2ecf20Sopenharmony_ci			continue;
508c2ecf20Sopenharmony_ci
518c2ecf20Sopenharmony_ci		/* Remap the duplicate events, as described above.  */
528c2ecf20Sopenharmony_ci		if (i == 2) {
538c2ecf20Sopenharmony_ci			if (event == 0)
548c2ecf20Sopenharmony_ci				event = 12+48;
558c2ecf20Sopenharmony_ci			else if (event == 2+41)
568c2ecf20Sopenharmony_ci				event = 4+65;
578c2ecf20Sopenharmony_ci		}
588c2ecf20Sopenharmony_ci
598c2ecf20Sopenharmony_ci		/* Convert the event numbers onto mux_select bit mask.  */
608c2ecf20Sopenharmony_ci		if (event < 2)
618c2ecf20Sopenharmony_ci			ctl |= event << 31;
628c2ecf20Sopenharmony_ci		else if (event < 24)
638c2ecf20Sopenharmony_ci			/* error */;
648c2ecf20Sopenharmony_ci		else if (event < 40)
658c2ecf20Sopenharmony_ci			ctl |= (event - 24) << 4;
668c2ecf20Sopenharmony_ci		else if (event < 48)
678c2ecf20Sopenharmony_ci			ctl |= (event - 40) << cbox1_ofs | 15 << 4;
688c2ecf20Sopenharmony_ci		else if (event < 64)
698c2ecf20Sopenharmony_ci			ctl |= event - 48;
708c2ecf20Sopenharmony_ci		else if (event < 72)
718c2ecf20Sopenharmony_ci			ctl |= (event - 64) << cbox2_ofs | 15;
728c2ecf20Sopenharmony_ci	}
738c2ecf20Sopenharmony_ci	reg->mux_select = ctl;
748c2ecf20Sopenharmony_ci
758c2ecf20Sopenharmony_ci	/* Select processor mode.  */
768c2ecf20Sopenharmony_ci	/* ??? Need to come up with some mechanism to trace only selected
778c2ecf20Sopenharmony_ci	   processes.  For now select from pal, kernel and user mode.  */
788c2ecf20Sopenharmony_ci	ctl = 0;
798c2ecf20Sopenharmony_ci	ctl |= !sys->enable_pal << 9;
808c2ecf20Sopenharmony_ci	ctl |= !sys->enable_kernel << 8;
818c2ecf20Sopenharmony_ci	ctl |= !sys->enable_user << 30;
828c2ecf20Sopenharmony_ci	reg->proc_mode = ctl;
838c2ecf20Sopenharmony_ci
848c2ecf20Sopenharmony_ci	/* Select interrupt frequencies.  Take the interrupt count selected
858c2ecf20Sopenharmony_ci	   by the user, and map it onto one of the possible counter widths.
868c2ecf20Sopenharmony_ci	   If the user value is in between, compute a value to which the
878c2ecf20Sopenharmony_ci	   counter is reset at each interrupt.  */
888c2ecf20Sopenharmony_ci
898c2ecf20Sopenharmony_ci	ctl = reset = need_reset = 0;
908c2ecf20Sopenharmony_ci	for (i = 0; i < 3; ++i) {
918c2ecf20Sopenharmony_ci		unsigned long max, hilo, count = ctr[i].count;
928c2ecf20Sopenharmony_ci		if (!ctr[i].enabled)
938c2ecf20Sopenharmony_ci			continue;
948c2ecf20Sopenharmony_ci
958c2ecf20Sopenharmony_ci		if (count <= 256)
968c2ecf20Sopenharmony_ci			count = 256, hilo = 3, max = 256;
978c2ecf20Sopenharmony_ci		else {
988c2ecf20Sopenharmony_ci			max = (i == 2 ? 16384 : 65536);
998c2ecf20Sopenharmony_ci			hilo = 2;
1008c2ecf20Sopenharmony_ci			if (count > max)
1018c2ecf20Sopenharmony_ci				count = max;
1028c2ecf20Sopenharmony_ci		}
1038c2ecf20Sopenharmony_ci		ctr[i].count = count;
1048c2ecf20Sopenharmony_ci
1058c2ecf20Sopenharmony_ci		ctl |= hilo << (8 - i*2);
1068c2ecf20Sopenharmony_ci		reset |= (max - count) << (48 - 16*i);
1078c2ecf20Sopenharmony_ci		if (count != max)
1088c2ecf20Sopenharmony_ci			need_reset |= 1 << i;
1098c2ecf20Sopenharmony_ci	}
1108c2ecf20Sopenharmony_ci	reg->freq = ctl;
1118c2ecf20Sopenharmony_ci	reg->reset_values = reset;
1128c2ecf20Sopenharmony_ci	reg->need_reset = need_reset;
1138c2ecf20Sopenharmony_ci}
1148c2ecf20Sopenharmony_ci
1158c2ecf20Sopenharmony_cistatic void
1168c2ecf20Sopenharmony_ciev5_reg_setup(struct op_register_config *reg,
1178c2ecf20Sopenharmony_ci	      struct op_counter_config *ctr,
1188c2ecf20Sopenharmony_ci	      struct op_system_config *sys)
1198c2ecf20Sopenharmony_ci{
1208c2ecf20Sopenharmony_ci	common_reg_setup(reg, ctr, sys, 19, 22);
1218c2ecf20Sopenharmony_ci}
1228c2ecf20Sopenharmony_ci
1238c2ecf20Sopenharmony_cistatic void
1248c2ecf20Sopenharmony_cipca56_reg_setup(struct op_register_config *reg,
1258c2ecf20Sopenharmony_ci	        struct op_counter_config *ctr,
1268c2ecf20Sopenharmony_ci	        struct op_system_config *sys)
1278c2ecf20Sopenharmony_ci{
1288c2ecf20Sopenharmony_ci	common_reg_setup(reg, ctr, sys, 8, 11);
1298c2ecf20Sopenharmony_ci}
1308c2ecf20Sopenharmony_ci
1318c2ecf20Sopenharmony_ci/* Program all of the registers in preparation for enabling profiling.  */
1328c2ecf20Sopenharmony_ci
1338c2ecf20Sopenharmony_cistatic void
1348c2ecf20Sopenharmony_ciev5_cpu_setup (void *x)
1358c2ecf20Sopenharmony_ci{
1368c2ecf20Sopenharmony_ci	struct op_register_config *reg = x;
1378c2ecf20Sopenharmony_ci
1388c2ecf20Sopenharmony_ci	wrperfmon(2, reg->mux_select);
1398c2ecf20Sopenharmony_ci	wrperfmon(3, reg->proc_mode);
1408c2ecf20Sopenharmony_ci	wrperfmon(4, reg->freq);
1418c2ecf20Sopenharmony_ci	wrperfmon(6, reg->reset_values);
1428c2ecf20Sopenharmony_ci}
1438c2ecf20Sopenharmony_ci
1448c2ecf20Sopenharmony_ci/* CTR is a counter for which the user has requested an interrupt count
1458c2ecf20Sopenharmony_ci   in between one of the widths selectable in hardware.  Reset the count
1468c2ecf20Sopenharmony_ci   for CTR to the value stored in REG->RESET_VALUES.
1478c2ecf20Sopenharmony_ci
1488c2ecf20Sopenharmony_ci   For EV5, this means disabling profiling, reading the current values,
1498c2ecf20Sopenharmony_ci   masking in the value for the desired register, writing, then turning
1508c2ecf20Sopenharmony_ci   profiling back on.
1518c2ecf20Sopenharmony_ci
1528c2ecf20Sopenharmony_ci   This can be streamlined if profiling is only enabled for user mode.
1538c2ecf20Sopenharmony_ci   In that case we know that the counters are not currently incrementing
1548c2ecf20Sopenharmony_ci   (due to being in kernel mode).  */
1558c2ecf20Sopenharmony_ci
1568c2ecf20Sopenharmony_cistatic void
1578c2ecf20Sopenharmony_ciev5_reset_ctr(struct op_register_config *reg, unsigned long ctr)
1588c2ecf20Sopenharmony_ci{
1598c2ecf20Sopenharmony_ci	unsigned long values, mask, not_pk, reset_values;
1608c2ecf20Sopenharmony_ci
1618c2ecf20Sopenharmony_ci	mask = (ctr == 0 ? 0xfffful << 48
1628c2ecf20Sopenharmony_ci	        : ctr == 1 ? 0xfffful << 32
1638c2ecf20Sopenharmony_ci		: 0x3fff << 16);
1648c2ecf20Sopenharmony_ci
1658c2ecf20Sopenharmony_ci	not_pk = 1 << 9 | 1 << 8;
1668c2ecf20Sopenharmony_ci
1678c2ecf20Sopenharmony_ci	reset_values = reg->reset_values;
1688c2ecf20Sopenharmony_ci
1698c2ecf20Sopenharmony_ci	if ((reg->proc_mode & not_pk) == not_pk) {
1708c2ecf20Sopenharmony_ci		values = wrperfmon(5, 0);
1718c2ecf20Sopenharmony_ci		values = (reset_values & mask) | (values & ~mask & -2);
1728c2ecf20Sopenharmony_ci		wrperfmon(6, values);
1738c2ecf20Sopenharmony_ci	} else {
1748c2ecf20Sopenharmony_ci		wrperfmon(0, -1);
1758c2ecf20Sopenharmony_ci		values = wrperfmon(5, 0);
1768c2ecf20Sopenharmony_ci		values = (reset_values & mask) | (values & ~mask & -2);
1778c2ecf20Sopenharmony_ci		wrperfmon(6, values);
1788c2ecf20Sopenharmony_ci		wrperfmon(1, reg->enable);
1798c2ecf20Sopenharmony_ci	}
1808c2ecf20Sopenharmony_ci}
1818c2ecf20Sopenharmony_ci
1828c2ecf20Sopenharmony_cistatic void
1838c2ecf20Sopenharmony_ciev5_handle_interrupt(unsigned long which, struct pt_regs *regs,
1848c2ecf20Sopenharmony_ci		     struct op_counter_config *ctr)
1858c2ecf20Sopenharmony_ci{
1868c2ecf20Sopenharmony_ci	/* Record the sample.  */
1878c2ecf20Sopenharmony_ci	oprofile_add_sample(regs, which);
1888c2ecf20Sopenharmony_ci}
1898c2ecf20Sopenharmony_ci
1908c2ecf20Sopenharmony_ci
1918c2ecf20Sopenharmony_cistruct op_axp_model op_model_ev5 = {
1928c2ecf20Sopenharmony_ci	.reg_setup		= ev5_reg_setup,
1938c2ecf20Sopenharmony_ci	.cpu_setup		= ev5_cpu_setup,
1948c2ecf20Sopenharmony_ci	.reset_ctr		= ev5_reset_ctr,
1958c2ecf20Sopenharmony_ci	.handle_interrupt	= ev5_handle_interrupt,
1968c2ecf20Sopenharmony_ci	.cpu_type		= "alpha/ev5",
1978c2ecf20Sopenharmony_ci	.num_counters		= 3,
1988c2ecf20Sopenharmony_ci	.can_set_proc_mode	= 1,
1998c2ecf20Sopenharmony_ci};
2008c2ecf20Sopenharmony_ci
2018c2ecf20Sopenharmony_cistruct op_axp_model op_model_pca56 = {
2028c2ecf20Sopenharmony_ci	.reg_setup		= pca56_reg_setup,
2038c2ecf20Sopenharmony_ci	.cpu_setup		= ev5_cpu_setup,
2048c2ecf20Sopenharmony_ci	.reset_ctr		= ev5_reset_ctr,
2058c2ecf20Sopenharmony_ci	.handle_interrupt	= ev5_handle_interrupt,
2068c2ecf20Sopenharmony_ci	.cpu_type		= "alpha/pca56",
2078c2ecf20Sopenharmony_ci	.num_counters		= 3,
2088c2ecf20Sopenharmony_ci	.can_set_proc_mode	= 1,
2098c2ecf20Sopenharmony_ci};
210