new/external/rk_pcba_test/mic_test_Linux/vibrate_test.c

#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <signal.h>
#include <pthread.h>
#include <fcntl.h>
#include <linux/input.h>
#include <string.h>
#include <sys/socket.h>
#include <sys/ioctl.h>
#include <net/if.h>
#include <stdio.h>
#include <netinet/in.h>
#include <arpa/inet.h>
#include "math.h"

#include "vibrate_test.h"
//#define printf(format, args...) fprintf (stderr, format, args)

#define LOG_TAG "i2c_controller"

#define FRAME_LENGTH 128

#define DATA_TYPE float

/*const int g_mic_table[5] = {
7,1,8,2,9	 
};*/

//static FILE * fp_in;
//static FILE * fp_out[12];
static int test_result;

int check_vibration(int signal, int input[], int input_length)
{
	float min = 0.5;
	float max = 0.0;
	DATA_TYPE sum0l = 0.0;
	DATA_TYPE sum0 = 0.0;
	int ind = 1;
	int i = 0, k = 0, j = 0, offset = 0;
	int first_index;
	long count = 0;;

	printf("start to check vibration, signal is %d\n", signal);
	if(input == NULL || input_length < 44800)
	{
		printf("error in input pcm, content : %d , length less than one frame\n", input_length);
		return -21;
	}

	i += 20;
	// 读取文件的第一个sample，取其index最为比较的标准
	first_index = input[i];
	first_index = (first_index >> 8) & 0xf;
	//if(first_index != 0x07 && first_index != 0x01 && first_index != 0x08 && first_index != 0x02 && first_index != 0x09)
	//{
	//	printf("pass check\n");
	//	return 0;
	//}
	int filesize = (input_length - 80)/sizeof(DATA_TYPE);
	int noofframe = filesize/FRAME_LENGTH;

	// 靠近风口的声道特殊处理
	/*if(first_index == 3 | first_index == 9)
	{
		printf("this is a special channel");
		//fseek(fp_test,57600,SEEK_SET);
		i = 57600;
	}
	else*/
	{
		//printf("this is a normal channel");
		//fseek(fp_test,44800,SEEK_SET);
		//i = 44800;
		i = 44800;
	}
	int *temp_intp = (int *)malloc( FRAME_LENGTH * sizeof(int) );

	DATA_TYPE maxA = 0;
	//while(!feof(fp_test))
	while(i + FRAME_LENGTH < input_length)
	{
		count++;
		k = k + 1;
		if (k < noofframe - 10)
		{
			//fread(temp_intp,sizeof(int),FRAME_LENGTH,fp_test);
			for(j = i, offset = 0; offset < FRAME_LENGTH; j++, offset++)
		    {
			    temp_intp[offset] = input[j];
		    }
			i += FRAME_LENGTH;
			//printf("input_length : %d, i : %d", input_length, i);
			sum0l = sum0;
			sum0 = 0.0;			
			
			for (j = 0; j < FRAME_LENGTH; j++)
			{
				int tmp = temp_intp[j] >> 8;
				float temp_float;
				temp_float = (float)tmp/0x800000;

				DATA_TYPE temp = 0;
				if(temp_float>0)
				{
					temp = temp_float;
				}
				else
				{
					temp = -temp_float;
				}
				if(temp>maxA)
				{
					maxA = temp;

				}
				sum0 += (temp_float) * (temp_float);

			}

			if (k == 1)
			{
				sum0 = sum0;
			}
			else
			{
				sum0 = (1-0.99) * sum0 + 0.99 * sum0l;
			}

			if (sum0<min)
			{
				min = sum0;
			}
			if (sum0>max)
			{
				max = sum0;
			}

		}
		else
		{
			break;
		}
	}
	
	free(temp_intp);
	printf("max is %2.3f\tmin is %2.3f\trate is %2.3f\n", max, min, max/(min+0.1));

	if (max>80*(min+.1))
	{
		ind = 1;
	}
	else
	{
		ind = 0;
	}

	printf("result is %d\tmaxA is %2.3f \n",ind, maxA);
	return ind;

}

int* vibrateTestWr(int audio_data[], int audio_length)
{
	int *buf;  
	static int ccids[13];
	int signal = 0;
	int i = 0, ret = 0;
	int rlength = audio_length / 10;
	int pcmIndex[12];
	int *pcmInput[12];

        buf = audio_data;
	memset(pcmIndex, 0, sizeof(pcmIndex));
	memset(ccids, 0, sizeof(ccids));

	if(buf == NULL) {  
		return NULL;
	}
	printf("start to check audio , vibrationtest!!!\n");
	for(i = 0; i <12; i++)
	{
		pcmInput[i] = malloc(sizeof(int) * rlength);
		if(pcmInput[i] == NULL)
		{
			printf("pcmInput malloc failed \n");
			return NULL;
		}
	}
	
	printf("split audio begin\n");
	while(i < audio_length)
	{
        signal = (buf[i]>>8)&15;
		if(signal > 0 && signal <= 12)
        {
			signal--;
			if(pcmIndex[signal] < rlength)
			{	
                *(pcmInput[signal] + pcmIndex[signal]) = buf[i];
			    pcmIndex[signal] ++;
			}	
        }
		else 
		{
            printf("signal : %d , less than 1 or larger than 12 \n", signal);
		}	
		i++;
	}
	printf("split audio success\n");
	
	// 检查频谱
	for(i = 0; i < 12; i++)
	{
		ret = check_vibration(i, pcmInput[i], pcmIndex[i]);
		if(ret != 0) 
		{
			printf("check vibration fail\n");
			ccids[i] = 1;
		} else {
			printf("check vibration success\n");
		}
	}
	for(i = 0; i <12; i++)
	{
		free(pcmInput[i]);
	}
	
	return ccids;
}