142 void g72x_init_state(struct g72x_state *state_ptr)  in g72x_init_state()  argument
146         state_ptr->yl = 34816;  in g72x_init_state()
147         state_ptr->yu = 544;  in g72x_init_state()
148         state_ptr->dms = 0;  in g72x_init_state()
149         state_ptr->dml = 0;  in g72x_init_state()
150         state_ptr->ap = 0;  in g72x_init_state()
152                 state_ptr->a[cnta] = 0;  in g72x_init_state()
153                 state_ptr->pk[cnta] = 0;  in g72x_init_state()
154                 state_ptr->sr[cnta] = 32;  in g72x_init_state()
157                 state_ptr->b[cnta] = 0;  in g72x_init_state()
158                 state_ptr->dq[cnta] = 32;  in g72x_init_state()
160         state_ptr->td = 0;  in g72x_init_state()
169 int predictor_zero(struct g72x_state *state_ptr)  in predictor_zero()  argument
174         sezi = fmult(state_ptr->b[0] >> 2, state_ptr->dq[0]);  in predictor_zero()
176                 sezi += fmult(state_ptr->b[i] >> 2, state_ptr->dq[i]);  in predictor_zero()
185 int predictor_pole(struct g72x_state *state_ptr)  in predictor_pole()  argument
187         return (fmult(state_ptr->a[1] >> 2, state_ptr->sr[1]) +  in predictor_pole()
188             fmult(state_ptr->a[0] >> 2, state_ptr->sr[0]));  in predictor_pole()
196 int step_size(struct g72x_state *state_ptr)  in step_size()  argument
202         if (state_ptr->ap >= 256)  in step_size()
203                 return (state_ptr->yu);  in step_size()
205                 y = state_ptr->yl >> 6;  in step_size()
206                 dif = state_ptr->yu - y;  in step_size()
207                 al = state_ptr->ap >> 2;  in step_size()
297             int dqsez, struct g72x_state *state_ptr)  in update()  argument
314         ylint = state_ptr->yl >> 15;    /* exponent part of yl */  in update()
315         ylfrac = (state_ptr->yl >> 10) & 0x1F;  /* fractional part of yl */  in update()
319         if (state_ptr->td == 0)         /* signal supposed voice */  in update()
332         state_ptr->yu = y + ((wi - y) >> 5);  in update()
335         if (state_ptr->yu < 544)        /* 544 <= yu <= 5120 */  in update()
336                 state_ptr->yu = 544;  in update()
337         else if (state_ptr->yu > 5120)  in update()
338                 state_ptr->yu = 5120;  in update()
342         state_ptr->yl += state_ptr->yu + ((-state_ptr->yl) >> 6);  in update()
348                 state_ptr->a[0] = 0;  in update()
349                 state_ptr->a[1] = 0;  in update()
350                 state_ptr->b[0] = 0;  in update()
351                 state_ptr->b[1] = 0;  in update()
352                 state_ptr->b[2] = 0;  in update()
353                 state_ptr->b[3] = 0;  in update()
354                 state_ptr->b[4] = 0;  in update()
355                 state_ptr->b[5] = 0;  in update()
357                 pks1 = pk0 ^ state_ptr->pk[0];          /* UPA2 */  in update()
360                 a2p = state_ptr->a[1] - (state_ptr->a[1] >> 7);  in update()
362                         fa1 = (pks1) ? state_ptr->a[0] : -state_ptr->a[0];  in update()
370                         if (pk0 ^ state_ptr->pk[1])  in update()
390                 state_ptr->a[1] = a2p;  in update()
394                 state_ptr->a[0] -= state_ptr->a[0] >> 8;  in update()
398                                 state_ptr->a[0] += 192;  in update()
400                                 state_ptr->a[0] -= 192;  in update()
404                 if (state_ptr->a[0] < -a1ul)  in update()
405                         state_ptr->a[0] = -a1ul;  in update()
406                 else if (state_ptr->a[0] > a1ul)  in update()
407                         state_ptr->a[0] = a1ul;  in update()
412                                 state_ptr->b[cnt] -= state_ptr->b[cnt] >> 9;  in update()
414                                 state_ptr->b[cnt] -= state_ptr->b[cnt] >> 8;  in update()
416                                 if ((dq ^ state_ptr->dq[cnt]) >= 0)  in update()
417                                         state_ptr->b[cnt] += 128;  in update()
419                                         state_ptr->b[cnt] -= 128;  in update()
425                 state_ptr->dq[cnt] = state_ptr->dq[cnt-1];  in update()
428                 state_ptr->dq[0] = (dq >= 0) ? 0x20 : (short)(unsigned short)0xFC20;  in update()
431                 state_ptr->dq[0] = (dq >= 0) ?  in update()
436         state_ptr->sr[1] = state_ptr->sr[0];  in update()
439                 state_ptr->sr[0] = 0x20;  in update()
442                 state_ptr->sr[0] = (exp << 6) + ((sr << 6) >> exp);  in update()
446                 state_ptr->sr[0] =  (exp << 6) + ((mag << 6) >> exp) - 0x400;  in update()
448                 state_ptr->sr[0] = (short)(unsigned short)0xFC20;  in update()
451         state_ptr->pk[1] = state_ptr->pk[0];  in update()
452         state_ptr->pk[0] = pk0;  in update()
456                 state_ptr->td = 0;      /* next one will be treated as voice */  in update()
458                 state_ptr->td = 1;      /* signal may be data */  in update()
460                 state_ptr->td = 0;  in update()
465         state_ptr->dms += (fi - state_ptr->dms) >> 5;           /* FILTA */  in update()
466         state_ptr->dml += (((fi << 2) - state_ptr->dml) >> 7);  /* FILTB */  in update()
469                 state_ptr->ap = 256;  in update()
471                 state_ptr->ap += (0x200 - state_ptr->ap) >> 4;  in update()
472         else if (state_ptr->td == 1)  in update()
473                 state_ptr->ap += (0x200 - state_ptr->ap) >> 4;  in update()
474         else if (abs((state_ptr->dms << 2) - state_ptr->dml) >=  in update()
475             (state_ptr->dml >> 3))  in update()
476                 state_ptr->ap += (0x200 - state_ptr->ap) >> 4;  in update()
478                 state_ptr->ap += (-state_ptr->ap) >> 4;  in update()