echo_cpu_test.c

/*
 *  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);
}