333 lines
9.4 KiB
C
Raw Normal View History

2025-05-10 21:49:39 +08:00
/*
* cpu_test.c -- cpu test application
*
* Copyright (c) 2017 Rockchip Electronics Co. Ltd.
* Author: Panzhenzhuan Wang <randy.wang@rock-chips.com>
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
/* Get CPU frequency */
#include <stdio.h>
/* error <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ͷ<EFBFBD>ļ<EFBFBD>*/
#include <errno.h>
#include <stdlib.h>
#include <string.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include "cpu_test.h"
#define LOG_TAG "cpu_test"
#include "common.h"
#define CPU_PROC_ERR -55
#define _CPU_FREQ_TABLE_PATH "/sys/devices/system/cpu/cpu%d/cpufreq/scaling_available_frequencies"
#define _CPU_FREQ_TXT "/data/cfg/rk_pcba_test/cpu%d_freq_table.txt"
#define _CPU_FREQ_GET "/sys/devices/system/cpu/cpu%d/cpufreq/scaling_cur_freq"
#define _CPU_FREQ_SET "/sys/devices/system/cpu/cpu%d/cpufreq/scaling_setspeed"
int cpu_num0 = 0;
CPU_FREQ cpu_0;
int cpu_num1 = 0;
CPU_FREQ cpu_1;
int cpu_num2 = 0;
CPU_FREQ cpu_2;
int cpu_num3 = 0;
CPU_FREQ cpu_3;
int cpu_space = 0;
//<2F><>һ<EFBFBD>CPU frequency test=========================
//===================================================
/* <20><>CPU<50><55><EFBFBD><EFBFBD>Ƶ<EFBFBD>ʼ<EFBFBD><CABC><EFBFBD>Ƶ<EFBFBD><C6B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD>*/
void Insert_list(CPU_FREQ *head, CPU_FREQ *item)
{
CPU_FREQ *p1 = NULL, *p0 = NULL;
p1 = head;
p0 = item;
p0->next = NULL;
if (head == NULL) {
head = p0;
} else {
while (p1 && p1->next)
p1 = p1->next;
if (p1->freq == 0){
p1->freq = p0->freq;
free(p0); //<2F><>Ҫ<EFBFBD>ͷ<EFBFBD>p0<70><30><EFBFBD><EFBFBD>Ȼitem<65>ڴ<EFBFBD>й©
}
else
p1->next = p0;
}
}
/* 1<><31><EFBFBD><EFBFBD>ȡCPU֧<55>ֵ<EFBFBD>frequency table, <20><><EFBFBD><EFBFBD><EFBFBD>ؿ<EFBFBD><D8BF><EFBFBD>CPUƵ<55>ʸ<EFBFBD><CAB8><EFBFBD>*/
int get_cpu_freq_table(int cpu_num, CPU_FREQ *cpu_freq_head)
{
char freq_table_path[512];
char freq_table_file[128];
printf("\n=================function :%s start \tcpu number: %d==================\n",__func__,cpu_num);
/* <20><>ȡCPU number <20><>Ӧ<EFBFBD><D3A6>frequency table ·<><C2B7>*/
memset(freq_table_path, 0, sizeof(freq_table_path));
sprintf(freq_table_path, _CPU_FREQ_TABLE_PATH, cpu_num);
printf("cpu: %d; freq_table_path is: %s\n",cpu_num,freq_table_path);
/* <20><>CPU frequency table<6C><65><EFBFBD><EFBFBD>ļ<EFBFBD><C4BC><EFBFBD> */
char cmd[1024];
memset(cmd, 0, sizeof(cmd));
memset(freq_table_file, 0,sizeof(freq_table_file));
sprintf(freq_table_file, _CPU_FREQ_TXT, cpu_num);
printf("cpu: %d; freq_table_file is: %s\n",cpu_num,freq_table_file);
sprintf(cmd, "busybox cat %s > %s", freq_table_path, freq_table_file);
if(system(cmd)<0)
{
perror("system(cmd)");
return -1;
}
/* <20><><EFBFBD><EFBFBD><EFBFBD>п<EFBFBD><D0BF>ܵ<EFBFBD>CPUƵ<55>ʼ<EFBFBD><CABC><EFBFBD><EBB5BD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>, <20><><EFBFBD><EFBFBD>ӡ<EFBFBD><D3A1><EFBFBD><EFBFBD><EFBFBD>õ<EFBFBD>Ƶ<EFBFBD>ʸ<EFBFBD><CAB8><EFBFBD>*/
FILE *fp_read = NULL;
char buf[64];
CPU_FREQ *new_freq;
fp_read = fopen(freq_table_file, "r");
if (NULL==fp_read) {
printf("%s open err:%s\r\n", freq_table_file,strerror(errno));
return -1;
}
//<2F><>ȡ<EFBFBD>ļ<EFBFBD><C4BC>и<EFBFBD>Ƶ<EFBFBD><C6B5>ֵ<EFBFBD><D6B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EBB5BD>cpu_freq_headΪͷ<CEAA><CDB7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
int freq_num = 0; //<2F><><EFBFBD><EFBFBD>Ƶ<EFBFBD>ʸ<EFBFBD><CAB8><EFBFBD>
while(!feof(fp_read)&&(fp_read!=NULL))
{
fscanf(fp_read,"%s",buf);
new_freq = calloc(1,sizeof(CPU_FREQ));
if (new_freq == NULL)
{
printf("%s:calloc err\r\n", __func__);
return -1;
break;
}
new_freq->freq = atoi(buf);
printf("cpu frequency num:%d,frequency is %d MHz\r\n",freq_num,new_freq->freq/1000);
Insert_list(cpu_freq_head, new_freq);
freq_num++;
}
fclose(fp_read);
remove(freq_table_file);
printf("cpu %d has %d availble frequencies\n",cpu_num,freq_num);
printf("\n=================function :%s finish \tcpu number: %d==================\n",__func__,cpu_num);
return freq_num;
}
/* 2<><32><EFBFBD><EFBFBD>ȡ<EFBFBD><C8A1>ǰǰCPU<50><55><EFBFBD><EFBFBD>Ƶ<EFBFBD>ʣ<EFBFBD><CAA3><EFBFBD>ӡ<EFBFBD><D3A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> */
int get_curl_freq(int cpu_num)
{
FILE *pp;
char cmd[512];
char cpufreq[64];
int cpu_curl_freq =0;
printf("\n=================function :%s start \tcpu number: %d==================\n",__func__,cpu_num);
/* <20><>ȡCPU 0/1/2/3 <20><>Ӧ<EFBFBD>ĵ<EFBFBD>ǰ<EFBFBD><C7B0><EFBFBD><EFBFBD>frequency·<79><C2B7>*/
memset(cmd, 0, sizeof(cmd));
sprintf(cmd, "busybox cat %s", _CPU_FREQ_GET);
sprintf(cmd, cmd, cpu_num);
printf("cpu: %d; get current frequency cmd is: %s\n",cpu_num,cmd);
pp = popen(cmd, "r");
//<2F><><EFBFBD><EFBFBD><EFBFBD>ļ<EFBFBD><C4BC><EFBFBD><EFBFBD><EFBFBD>ʧ<EFBFBD>ܣ<EFBFBD><DCA3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϣ
if (!pp)
{
printf("%s open err:%s\r\n", __func__,strerror(errno)); //ʹ<><CAB9>strerror<6F><72><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
return -1;
}
if (fgets(cpufreq, sizeof(cpufreq), pp) == NULL) {
printf("popen read from %s is NULL!\n",cmd);
pclose(pp);
return -1;
}
pclose(pp);
cpu_curl_freq = atoi(cpufreq);
printf("cpu<EFBFBD><EFBFBD>%d ; current frequency is: %d MHz\n",cpu_num,cpu_curl_freq/1000);
printf("\n=================function :%s finish \tcpu number: %d==================\n",__func__,cpu_num);
return cpu_curl_freq;
}
/* 3<><33><EFBFBD><EFBFBD><EFBFBD><EFBFBD>CPUһ<55><D2BB>֧<EFBFBD>ֵ<EFBFBD>CPU frequency */
//<2F><><EFBFBD><EFBFBD>CPU ģʽ
int cpu_set_mode(char *mode)
{
char cmd[512];
printf("\n=================== function :%s start======================\n",__func__);
if (cpu_num0 > 0) {
memset(cmd, 0, sizeof(cmd));
sprintf(cmd, "echo " "%s" " > %s", mode,_CPU_0_FREQ_GOVERNOR);
system(cmd);
}
if (cpu_num1 > 0) {
memset(cmd, 0, sizeof(cmd));
sprintf(cmd, "echo " "%s" " > %s", mode,_CPU_1_FREQ_GOVERNOR);
system(cmd);
}
if (cpu_num2 > 0) {
memset(cmd, 0, sizeof(cmd));
sprintf(cmd, "echo " "%s" " > %s", mode,_CPU_2_FREQ_GOVERNOR);
system(cmd);
}
if (cpu_num3 > 0) {
memset(cmd, 0, sizeof(cmd));
sprintf(cmd, "echo " "%s" " > %s", mode,_CPU_3_FREQ_GOVERNOR);
system(cmd);
}
printf("\n=================== function :%s finish======================\n",__func__);
return 0;
}
//<2F><><EFBFBD><EFBFBD>CPU <20>б<EFBFBD><D0B1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ƶ<EFBFBD>ʣ<EFBFBD><CAA3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>õ<EFBFBD>Ƶ<EFBFBD><C6B5>
int set_curl_freq(int cpu_num, int freq_num)
{
char cmd[512];
char CPU_FREQ_SET_PATH[128];
CPU_FREQ *cpu_freq;
CPU_FREQ *p;
int freq_set = 0;
printf("\n=================== function :%s start======================\n",__func__);
//ѡ<><D1A1>CPU_num<75><6D>Ӧ<EFBFBD><D3A6>Ƶ<EFBFBD><C6B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
switch(cpu_num){
case 0:
cpu_freq = &cpu_0;break;
case 1:
cpu_freq = &cpu_1;break;
case 2:
cpu_freq = &cpu_2;break;
case 3:
cpu_freq = &cpu_3;break;
}
p = cpu_freq;
while(p) {
if ((--freq_num) <= 0)
break;
if (p->next)
p = p->next;
}
/* <20><><EFBFBD><EFBFBD>CPU Ƶ<><C6B5>*/
freq_set = p->freq;
memset(cmd, 0, sizeof(cmd));
sprintf(CPU_FREQ_SET_PATH,_CPU_FREQ_SET,cpu_num);
sprintf(cmd, "echo %d > %s", freq_set, CPU_FREQ_SET_PATH);
printf("cpu: %d; set current frequency cmd is: %s\n",cpu_num,cmd);
system(cmd);
printf("\n=================== function :%s finish======================\n",__func__);
return freq_set;
}
void *cpu_test(void *argv)
{
char cmd[128];
int test_flag=0;
printf("======= cpu frequency test starting ========\n\n");
/* 1<><31><EFBFBD><EFBFBD><EFBFBD>ȴ<EFBFBD>ӡ<EFBFBD><D3A1>ÿ<EFBFBD><C3BF>CPU֧<55>ֵ<EFBFBD>CPU frequency table */
/* get all freq */
printf("********************get cpu frequency table start ***************\n");
cpu_num0 = get_cpu_freq_table(0,&cpu_0);
cpu_num1 = get_cpu_freq_table(1,&cpu_1);
// cpu_num2 = get_cpu_freq_table(2,&cpu_2);
// cpu_num3 = get_cpu_freq_table(3,&cpu_3);
if(-1 == cpu_num0|| -1== cpu_num1||-1 ==cpu_num2 || -1 ==cpu_num3)
{
test_flag = -1;
goto fail;
}
printf("********************get cpu frequency table finish***************\n\n");
/* 2<><32>Ȼ<EFBFBD><C8BB><EFBFBD><EFBFBD>ӡ<EFBFBD><D3A1>ĿǰCPU<50><55><EFBFBD>е<EFBFBD>frequency */
printf("********************get current cpu frequency start ***************\n");
int cpu_0_freq,cpu_1_freq;
cpu_0_freq = get_curl_freq(0);
cpu_1_freq = get_curl_freq(1);
if(cpu_0_freq == -1 || cpu_1_freq==-1)
{
test_flag = -1;
goto fail;
}
printf("********************get current cpu frequency finish ***************\n\n");
/* 3<><33><EFBFBD><EFBFBD><EFBFBD><EFBFBD>CPUһ<55><D2BB>֧<EFBFBD>ֵ<EFBFBD>CPU frequency */
printf("********************set cpu frequency start ***************\n");
/* set mode to userspace */
test_flag = cpu_set_mode(_CPU_MODE_USER);
int freq_get,freq_set =-1;
int cpu_num = 0; //ѡ<><D1A1>CPU 0
int freq_num = rand()%cpu_num0; //<2F><><EFBFBD><EFBFBD>ѡ<EFBFBD><D1A1>CPU֧<55><D6A7>Ƶ<EFBFBD><C6B5><EFBFBD>б<EFBFBD><D0B1>е<EFBFBD>һ<EFBFBD><EFBFBD><EEA3BB><EFBFBD>ܳ<EFBFBD><DCB3><EFBFBD>
freq_set = set_curl_freq(cpu_num, freq_num);
printf("********************set cpu frequency finish ***************\n");
/* 4<><34><EFBFBD><EFBFBD>ȡCPU<50><55>frequency<63><79> <20><EFBFBD>Ƿ<EFBFBD><C7B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD>õ<EFBFBD>һ<EFBFBD><D2BB>*/
freq_get = get_curl_freq(cpu_num);
if(freq_set == freq_get)
{
printf("Cpu frequency set and get is equal; is %d MHz\n",freq_set/1000);
}
else{
printf("Cpu frequency set and get is not equal; set failed\n");
printf("Cpu frequency set is :%d MHz\n",freq_set);
printf("Cpu frequency get is :%d MHz\n",freq_get);
test_flag = -1;
goto fail;
}
printf("======= cpu frequency test success ========\n");
return (void*)test_flag;
fail:
printf("======= cpu frequency test failed ========\n");
return (void*)test_flag;
}
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>cpu_test
int main(int argc, char *argv[])
{
int test_flag = 0,err_code = 0;
char buf[COMMAND_VALUESIZE] = "cpu_test";
char result[COMMAND_VALUESIZE] = RESULT_PASS;
test_flag = (int)cpu_test(argv[0]);
if(test_flag < 0)
{
strcpy(result,RESULT_FAIL);
err_code = CPU_PROC_ERR;
}
send_msg_to_server(buf, result, err_code);
}