Merge ../linux-2.6
[linux-2.6] / arch / powerpc / kernel / perfmon_fsl_booke.c
1 /* kernel/perfmon_fsl_booke.c
2  * Freescale Book-E Performance Monitor code
3  *
4  * Author: Andy Fleming
5  * Copyright (c) 2004 Freescale Semiconductor, Inc
6  *
7  *  This program is free software; you can redistribute it and/or
8  *  modify it under the terms of the GNU General Public License
9  *  as published by the Free Software Foundation; either version
10  *  2 of the License, or (at your option) any later version.
11  */
12
13 #include <linux/errno.h>
14 #include <linux/sched.h>
15 #include <linux/kernel.h>
16 #include <linux/mm.h>
17 #include <linux/stddef.h>
18 #include <linux/unistd.h>
19 #include <linux/ptrace.h>
20 #include <linux/slab.h>
21 #include <linux/user.h>
22 #include <linux/a.out.h>
23 #include <linux/interrupt.h>
24 #include <linux/config.h>
25 #include <linux/init.h>
26 #include <linux/module.h>
27 #include <linux/prctl.h>
28
29 #include <asm/pgtable.h>
30 #include <asm/uaccess.h>
31 #include <asm/system.h>
32 #include <asm/io.h>
33 #include <asm/reg.h>
34 #include <asm/xmon.h>
35 #include <asm/pmc.h>
36
37 static inline u32 get_pmlca(int ctr);
38 static inline void set_pmlca(int ctr, u32 pmlca);
39
40 static inline u32 get_pmlca(int ctr)
41 {
42         u32 pmlca;
43
44         switch (ctr) {
45                 case 0:
46                         pmlca = mfpmr(PMRN_PMLCA0);
47                         break;
48                 case 1:
49                         pmlca = mfpmr(PMRN_PMLCA1);
50                         break;
51                 case 2:
52                         pmlca = mfpmr(PMRN_PMLCA2);
53                         break;
54                 case 3:
55                         pmlca = mfpmr(PMRN_PMLCA3);
56                         break;
57                 default:
58                         panic("Bad ctr number\n");
59         }
60
61         return pmlca;
62 }
63
64 static inline void set_pmlca(int ctr, u32 pmlca)
65 {
66         switch (ctr) {
67                 case 0:
68                         mtpmr(PMRN_PMLCA0, pmlca);
69                         break;
70                 case 1:
71                         mtpmr(PMRN_PMLCA1, pmlca);
72                         break;
73                 case 2:
74                         mtpmr(PMRN_PMLCA2, pmlca);
75                         break;
76                 case 3:
77                         mtpmr(PMRN_PMLCA3, pmlca);
78                         break;
79                 default:
80                         panic("Bad ctr number\n");
81         }
82 }
83
84 void init_pmc_stop(int ctr)
85 {
86         u32 pmlca = (PMLCA_FC | PMLCA_FCS | PMLCA_FCU |
87                         PMLCA_FCM1 | PMLCA_FCM0);
88         u32 pmlcb = 0;
89
90         switch (ctr) {
91                 case 0:
92                         mtpmr(PMRN_PMLCA0, pmlca);
93                         mtpmr(PMRN_PMLCB0, pmlcb);
94                         break;
95                 case 1:
96                         mtpmr(PMRN_PMLCA1, pmlca);
97                         mtpmr(PMRN_PMLCB1, pmlcb);
98                         break;
99                 case 2:
100                         mtpmr(PMRN_PMLCA2, pmlca);
101                         mtpmr(PMRN_PMLCB2, pmlcb);
102                         break;
103                 case 3:
104                         mtpmr(PMRN_PMLCA3, pmlca);
105                         mtpmr(PMRN_PMLCB3, pmlcb);
106                         break;
107                 default:
108                         panic("Bad ctr number!\n");
109         }
110 }
111
112 void set_pmc_event(int ctr, int event)
113 {
114         u32 pmlca;
115
116         pmlca = get_pmlca(ctr);
117
118         pmlca = (pmlca & ~PMLCA_EVENT_MASK) |
119                 ((event << PMLCA_EVENT_SHIFT) &
120                  PMLCA_EVENT_MASK);
121
122         set_pmlca(ctr, pmlca);
123 }
124
125 void set_pmc_user_kernel(int ctr, int user, int kernel)
126 {
127         u32 pmlca;
128
129         pmlca = get_pmlca(ctr);
130
131         if(user)
132                 pmlca &= ~PMLCA_FCU;
133         else
134                 pmlca |= PMLCA_FCU;
135
136         if(kernel)
137                 pmlca &= ~PMLCA_FCS;
138         else
139                 pmlca |= PMLCA_FCS;
140
141         set_pmlca(ctr, pmlca);
142 }
143
144 void set_pmc_marked(int ctr, int mark0, int mark1)
145 {
146         u32 pmlca = get_pmlca(ctr);
147
148         if(mark0)
149                 pmlca &= ~PMLCA_FCM0;
150         else
151                 pmlca |= PMLCA_FCM0;
152
153         if(mark1)
154                 pmlca &= ~PMLCA_FCM1;
155         else
156                 pmlca |= PMLCA_FCM1;
157
158         set_pmlca(ctr, pmlca);
159 }
160
161 void pmc_start_ctr(int ctr, int enable)
162 {
163         u32 pmlca = get_pmlca(ctr);
164
165         pmlca &= ~PMLCA_FC;
166
167         if (enable)
168                 pmlca |= PMLCA_CE;
169         else
170                 pmlca &= ~PMLCA_CE;
171
172         set_pmlca(ctr, pmlca);
173 }
174
175 void pmc_start_ctrs(int enable)
176 {
177         u32 pmgc0 = mfpmr(PMRN_PMGC0);
178
179         pmgc0 &= ~PMGC0_FAC;
180         pmgc0 |= PMGC0_FCECE;
181
182         if (enable)
183                 pmgc0 |= PMGC0_PMIE;
184         else
185                 pmgc0 &= ~PMGC0_PMIE;
186
187         mtpmr(PMRN_PMGC0, pmgc0);
188 }
189
190 void pmc_stop_ctrs(void)
191 {
192         u32 pmgc0 = mfpmr(PMRN_PMGC0);
193
194         pmgc0 |= PMGC0_FAC;
195
196         pmgc0 &= ~(PMGC0_PMIE | PMGC0_FCECE);
197
198         mtpmr(PMRN_PMGC0, pmgc0);
199 }
200
201 void dump_pmcs(void)
202 {
203         printk("pmgc0: %x\n", mfpmr(PMRN_PMGC0));
204         printk("pmc\t\tpmlca\t\tpmlcb\n");
205         printk("%8x\t%8x\t%8x\n", mfpmr(PMRN_PMC0),
206                         mfpmr(PMRN_PMLCA0), mfpmr(PMRN_PMLCB0));
207         printk("%8x\t%8x\t%8x\n", mfpmr(PMRN_PMC1),
208                         mfpmr(PMRN_PMLCA1), mfpmr(PMRN_PMLCB1));
209         printk("%8x\t%8x\t%8x\n", mfpmr(PMRN_PMC2),
210                         mfpmr(PMRN_PMLCA2), mfpmr(PMRN_PMLCB2));
211         printk("%8x\t%8x\t%8x\n", mfpmr(PMRN_PMC3),
212                         mfpmr(PMRN_PMLCA3), mfpmr(PMRN_PMLCB3));
213 }
214
215 EXPORT_SYMBOL(init_pmc_stop);
216 EXPORT_SYMBOL(set_pmc_event);
217 EXPORT_SYMBOL(set_pmc_user_kernel);
218 EXPORT_SYMBOL(set_pmc_marked);
219 EXPORT_SYMBOL(pmc_start_ctr);
220 EXPORT_SYMBOL(pmc_start_ctrs);
221 EXPORT_SYMBOL(pmc_stop_ctrs);
222 EXPORT_SYMBOL(dump_pmcs);