/*
|
* 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 ´¦Àíº¯ÊýËùÐèÍ·Îļþ*/
|
#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;
|
|
//µÚÒ»ÏCPU frequency test=========================
|
//===================================================
|
/* ½«CPU¿ÉÓÃƵÂʼÓÈëƵÂÊÁ´±í*/
|
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); //ÐèÒªÊÍ·Åp0£¬²»È»itemÄÚ´æй©
|
}
|
else
|
p1->next = p0;
|
}
|
}
|
|
/* 1¡¢»ñÈ¡CPUÖ§³ÖµÄfrequency table, ²¢·µ»Ø¿ÉÓÃCPUƵÂʸöÊý*/
|
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);
|
/* »ñÈ¡CPU number ¶ÔÓ¦µÄfrequency table ·¾¶*/
|
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);
|
|
/* ½«CPU frequency tableµ¼Èëµ½ÎļþÖÐ */
|
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;
|
}
|
/* ½«ËùÓпÉÄܵÄCPUƵÂʼÓÈëµ½Á´±íÖÐ, ²¢´òÓ¡³ö¿ÉÓõÄƵÂʸöÊý*/
|
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;
|
}
|
//¶ÁÈ¡ÎļþÖи÷ƵÂÊÖµ£¬²¢²åÈëµ½ÒÔcpu_freq_headΪͷµÄÁ´±íÖÐ
|
int freq_num = 0; //¿ÉÓÃƵÂʸöÊý
|
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¡¢»ñÈ¡µ±Ç°Ç°CPUÔËÐÐƵÂÊ£¬´òÓ¡³öÀ´²¢·µ»Ø */
|
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);
|
/* »ñÈ¡CPU 0/1/2/3 ¶ÔÓ¦µÄµ±Ç°ÔËÐÐfrequency·¾¶*/
|
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");
|
|
//Èç¹ûÎļþ´ò¿ªÊ§°Ü£¬ÔòÊä³ö´íÎóÐÅÏ¢
|
if (!pp)
|
{
|
printf("%s open err:%s\r\n", __func__,strerror(errno)); //ʹÓÃstrerror£¨£©·Òë´íÎó´úÂë
|
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£º%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¡¢ÉèÖÃCPUÒ»¸öÖ§³ÖµÄCPU frequency */
|
//ÉèÖÃ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;
|
}
|
|
//ÉèÖÃCPU ÁбíÀïÃæµÄƵÂÊ£¬·µ»ØÉèÖõÄƵÂÊ
|
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__);
|
|
//Ñ¡ÔñCPU_num¶ÔÓ¦µÄƵÂÊÁ´±í
|
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;
|
}
|
|
/* ÉèÖÃCPU ƵÂÊ*/
|
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¡¢Ê×ÏÈ´òÓ¡³öÿ¸öCPUÖ§³ÖµÄ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¡¢È»ºó´òÓ¡³öÄ¿Ç°CPUÔËÐеÄ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¡¢ÉèÖÃCPUÒ»¸öÖ§³ÖµÄ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; //Ñ¡ÔñCPU 0
|
int freq_num = rand()%cpu_num0; //Ëæ»úÑ¡ÔñCPUÖ§³ÖƵÂÊÁбíÖеÄÒ»Ï¿ÉÄܳö´í
|
freq_set = set_curl_freq(cpu_num, freq_num);
|
printf("********************set cpu frequency finish ***************\n");
|
|
/* 4¡¢¶ÁÈ¡CPUµÄfrequency£¬ ²é¿´ÊÇ·ñÓëÉèÖõÄÒ»ÖÂ*/
|
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;
|
}
|
|
//Ö÷º¯ÊýÆô¶¯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);
|
}
|
