update for reading Re/F0/Q/DeltaT during music playback
[tas2557sw-android/tas2557-ftc.git] / factorytest.c
1 /*
2 ** =============================================================================
3 ** Copyright (c) 2016  Texas Instruments Inc.
4 **
5 ** This program is free software; you can redistribute it and/or modify it under
6 ** the terms of the GNU General Public License as published by the Free Software 
7 ** Foundation; version 2.
8 **
9 ** This program is distributed in the hope that it will be useful, but WITHOUT
10 ** ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
11 ** FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details.
12 **
13 ** You should have received a copy of the GNU General Public License along with
14 ** this program; if not, write to the Free Software Foundation, Inc., 51 Franklin
15 ** Street, Fifth Floor, Boston, MA 02110-1301, USA.
16 **
17 ** File:
18 **     factorytest.c
19 **
20 ** Description:
21 **     main program for TAS2555 factory test 
22 **
23 ** =============================================================================
24 */
26 #include <stdio.h>
27 #include <stdlib.h>
28 #include <stdbool.h>
29 #include <sys/types.h>
30 #include <sys/stat.h>
31 #include <string.h>
32 #include <fcntl.h>
34 #include "tas2557_ftc.h"
36 // ================================================================ Definitions
37 // Obtained from Speaker Manufacturer
38 #define SPK_T_MAX            100    // Speaker Maximum Temperature (C)
39 #define SPK_RE_TOL_PER       10     // Re +/- tolerance (%)
40 #define SPK_RE_ALPHA         0.0039 // Temperature coefficient alpha (1/K)
42 // Obtained from PurePath Console 3 (PPC3)
43 #define PPC3_RE0             7.41   // Re0 (ohm)
44 #define PPC3_FWARP           891
45 #define PPC3_BL              0.814
46 #define PPC3_MMS             0.0666
47 #define PPC3_RTV             46.5   // Rtv (K/W)
48 #define PPC3_RTM             78.2   // Rtm (K/W)
49 #define PPC3_RTVA            2460   // Rtva (K/W)
50 #define PPC3_SYSGAIN         9.35   // System Gain (V/FS)
51 #define PPC3_DEV_NONLIN_PER  1.5    // Device Non-linearity (%)
52 #define PPC3_PIG                        1
54 void ExitWithHint(char *pHint)
55 {
56         printf("factorytest: invalid command line: %s\n\r\n\r", pHint);
58         printf("usage: factorytest [-t temperature] [-c configuration file] [-l load calibration] [-v verbose]\n\r");
59         exit(-1);
60 }
62 void InitFTCC(struct TFTCConfiguration *pFTCC)
63 {
64         pFTCC->nCalibrationTime = 2000;
65         pFTCC->nPPC3_FS = 48000;
67         pFTCC->bVerbose = false;
68         pFTCC->bLoadCalibration = false;
70         pFTCC->nTSpkCharDevA.nSpkTMax = SPK_T_MAX;
71         pFTCC->nTSpkCharDevA.nSpkReTolPer = SPK_RE_TOL_PER;
72         pFTCC->nTSpkCharDevA.nSpkReAlpha = SPK_RE_ALPHA;
73         pFTCC->nTSpkCharDevA.nReHi = PPC3_RE0*1.15;
74         pFTCC->nTSpkCharDevA.nReLo = PPC3_RE0*0.85;
75         pFTCC->nTSpkCharDevA.nPPC3_Re0 = PPC3_RE0;
76         pFTCC->nTSpkCharDevA.nPPC3_FWarp = PPC3_FWARP;
77         pFTCC->nTSpkCharDevA.nPPC3_Bl = PPC3_BL;
78         pFTCC->nTSpkCharDevA.nPPC3_Mms = PPC3_MMS;
79         pFTCC->nTSpkCharDevA.nPPC3_RTV = PPC3_RTV;
80         pFTCC->nTSpkCharDevA.nPPC3_RTM = PPC3_RTM;
81         pFTCC->nTSpkCharDevA.nPPC3_RTVA = PPC3_RTVA;
82         pFTCC->nTSpkCharDevA.nPPC3_SysGain = PPC3_SYSGAIN;
83         pFTCC->nTSpkCharDevA.nPPC3_DevNonlinPer = PPC3_DEV_NONLIN_PER;
84         pFTCC->nTSpkCharDevA.nPPC3_PIG = PPC3_PIG;
85 }
87 unsigned int SkipCharacter(char *pData, char cCharacter, unsigned int nSize)
88 {
89         unsigned int nRIndex;
90         unsigned int nWIndex = 0;
92         for (nRIndex = 0; nRIndex < nSize; nRIndex++)
93                 if (pData[nRIndex] != cCharacter) pData[nWIndex++] = pData[nRIndex];
95         return nWIndex;
96 }
98 unsigned int RemoveComments(char *pData, char cCharacter, unsigned int nSize)
99 {
100         unsigned int nRIndex;
101         unsigned int nWIndex = 0;
103         for (nRIndex = 0; nRIndex < nSize; nRIndex++)
104         {
105                 if (pData[nRIndex] == cCharacter)
106                         while ((nRIndex < nSize) && (pData[nRIndex] != '\r')) nRIndex++;
107                 pData[nWIndex++] = pData[nRIndex];
108         }
110         return nWIndex;
113 void ReadValue(struct TFTCConfiguration *pFTCC, struct TSPKCharData *pSpk, char *pLine, char *pValue)
115         if (!strcmp(pLine, "CALIBRATION_TIME")) {pFTCC->nCalibrationTime = atoi(pValue); return;};
116         if (!strcmp(pLine, "FS_RATE")) {pFTCC->nPPC3_FS = atof(pValue); return;};
117         if (!strcmp(pLine, "SPK_T_MAX")) {pSpk->nSpkTMax = atof(pValue); return;};
118         if (!strcmp(pLine, "SPK_RE_TOL_PER")) {pSpk->nSpkReTolPer = atof(pValue); return;};
119         if (!strcmp(pLine, "PPC3_RE_ALPHA")) {pSpk->nSpkReAlpha = atof(pValue); return;};
120         if (!strcmp(pLine, "PPC3_RE0")) {pSpk->nPPC3_Re0 = atof(pValue); return;};
121         if (!strcmp(pLine, "PPC3_FWARP")) {pSpk->nPPC3_FWarp = atof(pValue); return;};
122         if (!strcmp(pLine, "PPC3_BL")) {pSpk->nPPC3_Bl = atof(pValue); return;};
123         if (!strcmp(pLine, "PPC3_MMS")) {pSpk->nPPC3_Mms = atof(pValue); return;};
124         if (!strcmp(pLine, "PPC3_RTV")) {pSpk->nPPC3_RTV = atof(pValue); return;};
125         if (!strcmp(pLine, "PPC3_RTM")) {pSpk->nPPC3_RTM = atof(pValue); return;};
126         if (!strcmp(pLine, "PPC3_RTVA")) {pSpk->nPPC3_RTVA = atof(pValue); return;};
127         if (!strcmp(pLine, "PPC3_SYSGAIN")) {pSpk->nPPC3_SysGain = atof(pValue); return;};
128         if (!strcmp(pLine, "PPC3_DEV_NONLIN_PER")) {pSpk->nPPC3_DevNonlinPer = atof(pValue); return;};
129         if (!strcmp(pLine, "PPC3_PIG")) {pSpk->nPPC3_PIG = atof(pValue); return;};
130         if (!strcmp(pLine, "RE_HI")) {pSpk->nReHi = atof(pValue); return;};
131         if (!strcmp(pLine, "RE_LO")) {pSpk->nReLo = atof(pValue); return;};
134 void ftcc_print(struct TFTCConfiguration *pFTCC)
136         printf("factorytest configuration: \n\r");
138         printf("  CALIBRATION_TIME   = %d\n\r", pFTCC->nCalibrationTime);
139         printf("Speaker A characterization data: \n\r");
141         printf(" SPKA SPK_T_MAX      = %2.2f\n\r", pFTCC->nTSpkCharDevA.nSpkTMax);
142         printf(" SPKA SPK_RE_TOL_PER = %2.2f\n\r", pFTCC->nTSpkCharDevA.nSpkReTolPer);
143         printf(" SPKA SPK_RE_ALPHA   = %2.4f\n\r\n\r", pFTCC->nTSpkCharDevA.nSpkReAlpha);
145         printf(" SPKA PPC3_RE0            = %2.2f\n\r", pFTCC->nTSpkCharDevA.nPPC3_Re0);
146         printf(" SPKA PPC3_FWARP          = %2.2f\n\r", pFTCC->nTSpkCharDevA.nPPC3_FWarp);
147         printf(" SPKA PPC3_BL             = %2.6f\n\r", pFTCC->nTSpkCharDevA.nPPC3_Bl);
148         printf(" SPKA PPC3_MMS            = %2.6f\n\r", pFTCC->nTSpkCharDevA.nPPC3_Mms);
149         printf(" SPKA PPC3_RTV            = %2.2f\n\r", pFTCC->nTSpkCharDevA.nPPC3_RTV);
150         printf(" SPKA PPC3_RTM            = %2.2f\n\r", pFTCC->nTSpkCharDevA.nPPC3_RTM);
151         printf(" SPKA PPC3_RTVA           = %2.2f\n\r", pFTCC->nTSpkCharDevA.nPPC3_RTVA);
152         printf(" SPKA PPC3_SYSGAIN        = %2.2f\n\r", pFTCC->nTSpkCharDevA.nPPC3_SysGain);
153         printf(" SPKA PPC3_DEV_NONLIN_PER = %2.2f\n\r", pFTCC->nTSpkCharDevA.nPPC3_DevNonlinPer);
154         printf(" SPKA PPC3_PIG            = %f\n\r", pFTCC->nTSpkCharDevA.nPPC3_PIG);
157 int ftcc_parse(struct TFTCConfiguration *pFTCC, struct TSPKCharData *pSpk, char *pData, unsigned int nSize)
159         unsigned int nRIndex = 0;
160         char *pLine;
161         char *pEqual;
162         double nTest;
164         nSize = SkipCharacter(pData, ' ', nSize);
165         nSize = RemoveComments(pData, ';', nSize);
167         pData[nSize] = 0;
169         pLine = strtok(pData, "\n\r");
171 //      printf("ftcc_parse: pData = %s\n\r", pData);
173 //      printf("ftcc_parse: size = %d, pLine = 0x%08x\n\r", nSize, pLine);
174         while (pLine) {
175 //              printf("ftcc_parse: pLine = 0x%08x\n\r", pLine);
176                 if (pLine[0]) {
177                         printf("Line = %s\n\r", pLine);
178                         pEqual = strstr(pLine, "=");
179                         if ((pEqual) && (strlen(pEqual) > 1)) {
180                                 pEqual[0] = 0;
181                                 ReadValue(pFTCC, pSpk, pLine, pEqual + 1);
182                                 pEqual[0] = '=';
183                         }
184                 }
185                 pLine = strtok(NULL, "\n\r");
186         }
188         return 0;
191 void LoadFTCC(char *pFileName, struct TFTCConfiguration *pFTCC, struct TSPKCharData *pSpk)
193         struct stat st;
194         char *pData;
195         int nFile;
196         
197 //      printf("LoadFTCC: %s\n\r", pFileName);
199         if (stat(pFileName, &st) < 0) ExitWithHint("configuration file doesn't exist");
201         pData = malloc(st.st_size);
202         if (!pData) ExitWithHint("cannot allocate memory for configuation file");
204     nFile = open(pFileName, O_RDONLY);
205         if (nFile < 0) ExitWithHint("cannot open configuration file"); 
207         read(nFile, pData, st.st_size);
208         close(nFile);
210         ftcc_parse(pFTCC, pSpk, pData, st.st_size); 
212         free(pData);
215 int main(int argc, char *argv[])
217         double nTemp = 20.0;
218         int nArg = 1;
219         bool bValidArg;
220         bool bSpkChk = false;
221         char pHint[256];
222         struct TFTCConfiguration sFTCC;
224         printf("\nTI TAS2557 factory test calibration sequence V1.0\n");
226         InitFTCC(&sFTCC);
227 //      printf("argc = %d\n\r", argc);
228         while (nArg < argc)
229         {
230 //              printf("argv[%d] = %s: ", nArg, argv[nArg]);
231                 bValidArg = false;
232                 if (!strcmp(argv[nArg], "-t")) {
233                         printf("nArg = %d, argc = %d\n\r", nArg, argc);
234                         if (argc <= (nArg + 1))
235                                 ExitWithHint("temperature parameter is missing");
236                         nTemp = atof(argv[nArg + 1]);
237                         nArg++;
238                         bValidArg = true;
239                 }
241                 if (!strcmp(argv[nArg], "-c")) {
242 //                      printf("found configuration file argument\n\r");
243                         if (argc <= (nArg + 1))
244                                 ExitWithHint("configuration file name is missing");
245                         LoadFTCC(argv[nArg + 1], &sFTCC, &(sFTCC.nTSpkCharDevA));
246                         nArg++;
247                         bValidArg = true;
248                 }
250                 if (!strcmp(argv[nArg], "-v")) {
251                         sFTCC.bVerbose = true;
252                         bValidArg = true;
253                 }
255                 if (!strcmp(argv[nArg], "-u")) {
256                         sFTCC.bLoadCalibration = true;
257                         bValidArg = true;
258                 }
260                 if (!strcmp(argv[nArg], "-m")) {
261                         bSpkChk = true;
262                         bValidArg = true;
263                 }
265                 if (!bValidArg) {
266                         sprintf(pHint, "don't know argument %s", argv[nArg]);
267                         ExitWithHint(pHint);
268                 }
270                 nArg++;
271         }
273         if (sFTCC.bVerbose) {
274                 printf("\n\rambient temperature = %2.1f\n\r", nTemp);
275                 ftcc_print(&sFTCC);
276         }
278         if (bSpkChk)
279                 tas2557_chk(nTemp, &sFTCC);
280         else
281                 tas2557_ftc(nTemp, &sFTCC);
282         return 0;