033386224ffde52a463522ebc3f277113af5df97
[15.05/openwrt.git] / target / linux / generic / files / crypto / ocf / kirkwood / mvHal / mv_hal / cpu / mvCpuL2Cntrs.c
1 /*
2  * This program is free software; you can redistribute it and/or modify
3  * it under the terms of the GNU General Public License as published by
4  * the Free Software Foundation; either version 2 of the License, or
5  * (at your option) any later version.
6  *
7  * This program is distributed in the hope that it will be useful,
8  * but WITHOUT ANY WARRANTY; without even the implied warranty of
9  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
10  * GNU General Public License for more details.
11  *
12  * You should have received a copy of the GNU General Public License
13  * along with this program; if not, write to the Free Software
14  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
15  */
16
17 #include "mvOs.h"
18 #include "mvCpuL2Cntrs.h"
19
20
21
22 MV_CPU_L2_CNTRS_ENTRY   mvCpuL2CntrsTbl[MV_CPU_L2_CNTRS_NUM];
23
24 MV_CPU_L2_CNTRS_EVENT*  mvCpuL2CntrsEventTbl[128];
25
26 void mvCpuL2CntrsReset(void)
27 {
28     MV_U32 reg = 0;
29    
30     MV_ASM ("mcr p15, 6, %0, c15, c13, 0" : : "r" (reg));
31     MV_ASM ("mcr p15, 6, %0, c15, c13, 1" : : "r" (reg));
32     MV_ASM ("mcr p15, 6, %0, c15, c13, 2" : : "r" (reg));
33     MV_ASM ("mcr p15, 6, %0, c15, c13, 3" : : "r" (reg));
34 }
35                
36 static void mvCpuL2CntrConfig(int counter, int op)
37 {
38     MV_U32 reg =  (1 << op) | 0x1; /*enable*/
39
40     switch(counter)
41     {
42         case 0:
43          MV_ASM ("mcr p15, 6, %0, c15, c12, 0" : : "r" (reg));
44          return;
45
46         case 1:
47          MV_ASM ("mcr p15, 6, %0, c15, c12, 1" : : "r" (reg));
48          return;
49
50         default:
51             mvOsPrintf("mvCpuL2CntrConfig: bad counter number (%d)\n", counter);
52     }
53     return;
54 }
55
56 void mvCpuL2CntrsEventClear(MV_CPU_L2_CNTRS_EVENT* pEvent)
57 {
58     int i;
59
60     for(i=0; i<MV_CPU_L2_CNTRS_NUM; i++)
61     {
62         pEvent->counters_sum[i] = 0;
63     }
64     pEvent->num_of_measurements = 0;
65 }
66
67                                                                                                               
68 MV_CPU_L2_CNTRS_EVENT* mvCpuL2CntrsEventCreate(char* name, MV_U32 print_threshold)
69 {
70     int                     i;
71     MV_CPU_L2_CNTRS_EVENT*  event = mvOsMalloc(sizeof(MV_CPU_L2_CNTRS_EVENT));
72
73     if(event)
74     {
75         strncpy(event->name, name, sizeof(event->name));
76         event->num_of_measurements = 0;
77         event->avg_sample_count = print_threshold;
78         for(i=0; i<MV_CPU_L2_CNTRS_NUM; i++)
79         {
80             event->counters_before[i] = 0;
81             event->counters_after[i] = 0;
82             event->counters_sum[i] = 0;
83         }
84     }
85     return event;
86 }
87
88 void    mvCpuL2CntrsEventDelete(MV_CPU_L2_CNTRS_EVENT* event)
89 {
90     if(event != NULL)
91         mvOsFree(event);
92 }
93
94                                                                                      
95 MV_STATUS   mvCpuL2CntrsProgram(int counter, MV_CPU_L2_CNTRS_OPS op, 
96                                  char* name, MV_U32 overhead)
97 {
98     strncpy(mvCpuL2CntrsTbl[counter].name, name, sizeof(mvCpuL2CntrsTbl[counter].name));
99     mvCpuL2CntrsTbl[counter].operation = op;
100     mvCpuL2CntrsTbl[counter].opIdx = op;
101     mvCpuL2CntrsTbl[counter].overhead = overhead;
102     mvCpuL2CntrConfig(counter, op);
103     mvOsPrintf("CPU L2 Counter %d: operation=%d, overhead=%d\n",
104                         counter, op, overhead);
105     return MV_OK;
106 }
107
108 void    mvCpuL2CntrsShow(MV_CPU_L2_CNTRS_EVENT* pEvent)
109 {
110     int     i;
111     MV_U64  counters_avg;
112
113     if(pEvent->num_of_measurements < pEvent->avg_sample_count) 
114         return;
115
116     mvOsPrintf("%16s: ", pEvent->name);
117     for(i=0; i<MV_CPU_L2_CNTRS_NUM; i++)
118     {
119         counters_avg = mvOsDivMod64(pEvent->counters_sum[i], 
120                                     pEvent->num_of_measurements, NULL);
121
122         if(counters_avg >= mvCpuL2CntrsTbl[i].overhead)
123             counters_avg -= mvCpuL2CntrsTbl[i].overhead;
124         else
125             counters_avg = 0;
126
127         mvOsPrintf("%s=%5llu, ", mvCpuL2CntrsTbl[i].name, counters_avg);
128     }
129     mvOsPrintf("\n");
130     mvCpuL2CntrsEventClear(pEvent);
131     mvCpuL2CntrsReset();
132 }
133
134 void    mvCpuL2CntrsStatus(void)
135 {
136     int i;
137
138     for(i=0; i<MV_CPU_L2_CNTRS_NUM; i++)
139     {
140         mvOsPrintf("#%d: %s, overhead=%d\n", 
141             i, mvCpuL2CntrsTbl[i].name, mvCpuL2CntrsTbl[i].overhead);
142     }
143 }