Lines Matching full:up

116  * x40	Codec error (overrun). The machine is not fast enough to keep up
130 * probably chew up too much CPU time anyway.
292 irig_start, /* start up driver */
312 struct irigunit *up; in irig_start() local
335 up = emalloc_zero(sizeof(*up)); in irig_start()
344 free(up); in irig_start()
347 pp->unitptr = up; in irig_start()
355 up->tc = MINTC; in irig_start()
356 up->decim = 1; in irig_start()
357 up->gain = 127; in irig_start()
363 up->comp[0] = up->comp[OFFSET] = 0.; in irig_start()
364 up->comp[1] = 1; up->comp[OFFSET + 1] = -1.; in irig_start()
365 up->comp[2] = 3; up->comp[OFFSET + 2] = -3.; in irig_start()
368 up->comp[i] = up->comp[i - 1] + step; in irig_start()
369 up->comp[OFFSET + i] = -up->comp[i]; in irig_start()
373 DTOLFP(1. / SECOND, &up->tick); in irig_start()
388 struct irigunit *up; in irig_shutdown() local
391 up = pp->unitptr; in irig_shutdown()
394 if (NULL != up) in irig_shutdown()
395 free(up); in irig_shutdown()
412 struct irigunit *up; in irig_receive() local
424 up = pp->unitptr; in irig_receive()
432 up->timestamp = rbufp->recv_time; in irig_receive()
435 sample = up->comp[~*dpt++ & 0xff]; in irig_receive()
445 up->phase += (up->freq + clock_codec) / SECOND; in irig_receive()
446 up->phase += pp->fudgetime2 / 1e6; in irig_receive()
447 if (up->phase >= .5) { in irig_receive()
448 up->phase -= 1.; in irig_receive()
449 } else if (up->phase < -.5) { in irig_receive()
450 up->phase += 1.; in irig_receive()
456 L_ADD(&up->timestamp, &up->tick); in irig_receive()
458 if (sample > up->signal) in irig_receive()
459 up->signal = sample; in irig_receive()
460 up->signal += (sample - up->signal) / in irig_receive()
466 up->seccnt = (up->seccnt + 1) % SECOND; in irig_receive()
467 if (up->seccnt == 0) { in irig_receive()
468 if (up->irig_b > up->irig_e) { in irig_receive()
469 up->decim = 1; in irig_receive()
470 up->fdelay = IRIG_B; in irig_receive()
472 up->decim = 10; in irig_receive()
473 up->fdelay = IRIG_E; in irig_receive()
475 up->irig_b = up->irig_e = 0; in irig_receive()
485 up->port = 2; in irig_receive()
487 up->port = 1; in irig_receive()
489 up->mongain = MONGAIN; in irig_receive()
491 up->mongain = 0; in irig_receive()
512 struct irigunit *up; in irig_rf() local
520 up = pp->unitptr; in irig_rf()
527 irig_b = (up->bpf[8] = up->bpf[7]) * 6.505491e-001; in irig_rf()
528 irig_b += (up->bpf[7] = up->bpf[6]) * -3.875180e+000; in irig_rf()
529 irig_b += (up->bpf[6] = up->bpf[5]) * 1.151180e+001; in irig_rf()
530 irig_b += (up->bpf[5] = up->bpf[4]) * -2.141264e+001; in irig_rf()
531 irig_b += (up->bpf[4] = up->bpf[3]) * 2.712837e+001; in irig_rf()
532 irig_b += (up->bpf[3] = up->bpf[2]) * -2.384486e+001; in irig_rf()
533 irig_b += (up->bpf[2] = up->bpf[1]) * 1.427663e+001; in irig_rf()
534 irig_b += (up->bpf[1] = up->bpf[0]) * -5.352734e+000; in irig_rf()
535 up->bpf[0] = sample - irig_b; in irig_rf()
536 irig_b = up->bpf[0] * 4.952157e-003 in irig_rf()
537 + up->bpf[1] * -2.055878e-002 in irig_rf()
538 + up->bpf[2] * 4.401413e-002 in irig_rf()
539 + up->bpf[3] * -6.558851e-002 in irig_rf()
540 + up->bpf[4] * 7.462108e-002 in irig_rf()
541 + up->bpf[5] * -6.558851e-002 in irig_rf()
542 + up->bpf[6] * 4.401413e-002 in irig_rf()
543 + up->bpf[7] * -2.055878e-002 in irig_rf()
544 + up->bpf[8] * 4.952157e-003; in irig_rf()
545 up->irig_b += irig_b * irig_b; in irig_rf()
552 irig_e = (up->lpf[4] = up->lpf[3]) * 8.694604e-001; in irig_rf()
553 irig_e += (up->lpf[3] = up->lpf[2]) * -3.589893e+000; in irig_rf()
554 irig_e += (up->lpf[2] = up->lpf[1]) * 5.570154e+000; in irig_rf()
555 irig_e += (up->lpf[1] = up->lpf[0]) * -3.849667e+000; in irig_rf()
556 up->lpf[0] = sample - irig_e; in irig_rf()
557 irig_e = up->lpf[0] * 3.215696e-003 in irig_rf()
558 + up->lpf[1] * -1.174951e-002 in irig_rf()
559 + up->lpf[2] * 1.712074e-002 in irig_rf()
560 + up->lpf[3] * -1.174951e-002 in irig_rf()
561 + up->lpf[4] * 3.215696e-003; in irig_rf()
562 up->irig_e += irig_e * irig_e; in irig_rf()
567 up->badcnt = (up->badcnt + 1) % up->decim; in irig_rf()
568 if (up->badcnt == 0) { in irig_rf()
569 if (up->decim == 1) in irig_rf()
591 struct irigunit *up; in irig_base() local
602 up = pp->unitptr; in irig_base()
610 up->envphase = (up->envphase + 1) % BAUD; in irig_base()
611 up->integ[up->envphase] += (sample - up->integ[up->envphase]) / in irig_base()
612 (5 * up->tc); in irig_base()
613 lope = up->integ[up->envphase]; in irig_base()
614 carphase = up->envphase % CYCLE; in irig_base()
615 up->lastenv[carphase] = sample; in irig_base()
616 up->lastint[carphase] = lope; in irig_base()
623 if (up->lastsig > 0 && lope <= 0) in irig_base()
624 up->zxing += (double)(carphase - 4) / CYCLE; in irig_base()
625 up->lastsig = lope; in irig_base()
631 if (up->envphase == 0) { in irig_base()
632 up->maxsignal = up->intmax; up->noise = up->intmin; in irig_base()
633 up->intmin = 1e6; up->intmax = -1e6; in irig_base()
634 if (up->maxsignal < DRPOUT) in irig_base()
635 up->errflg |= IRIG_ERR_AMP; in irig_base()
636 if (up->maxsignal > 0) in irig_base()
637 up->modndx = (up->maxsignal - up->noise) / in irig_base()
638 up->maxsignal; in irig_base()
640 up->modndx = 0; in irig_base()
641 if (up->modndx < MODMIN) in irig_base()
642 up->errflg |= IRIG_ERR_MOD; in irig_base()
643 if (up->errflg & (IRIG_ERR_AMP | IRIG_ERR_FREQ | in irig_base()
645 up->tc = MINTC; in irig_base()
646 up->tcount = 0; in irig_base()
656 dtemp = up->zxing * up->decim / BAUD; in irig_base()
657 up->yxing = dtemp; in irig_base()
658 up->zxing = 0.; in irig_base()
659 up->phase += dtemp / up->tc; in irig_base()
660 up->freq += dtemp / (4. * up->tc * up->tc); in irig_base()
661 if (up->freq > MAXFREQ) { in irig_base()
662 up->freq = MAXFREQ; in irig_base()
663 up->errflg |= IRIG_ERR_FREQ; in irig_base()
664 } else if (up->freq < -MAXFREQ) { in irig_base()
665 up->freq = -MAXFREQ; in irig_base()
666 up->errflg |= IRIG_ERR_FREQ; in irig_base()
683 lope = (up->lastint[2] - up->lastint[6]) / 2.; in irig_base()
684 if (lope > up->intmax) in irig_base()
685 up->intmax = lope; in irig_base()
686 if (lope < up->intmin) in irig_base()
687 up->intmin = lope; in irig_base()
695 up->pulse = (up->pulse + 1) % 10; in irig_base()
696 up->cycles <<= 1; in irig_base()
697 if (lope >= (up->maxsignal + up->noise) / 2.) in irig_base()
698 up->cycles |= 1; in irig_base()
699 if ((up->cycles & 0x303c0f03) == 0x300c0300) { in irig_base()
700 if (up->pulse != 0) in irig_base()
701 up->errflg |= IRIG_ERR_SYNCH; in irig_base()
702 up->pulse = 0; in irig_base()
711 env = (up->lastenv[2] - up->lastenv[6]) / 2.; in irig_base()
712 up->dcycles <<= 1; in irig_base()
713 if (env >= up->slice) in irig_base()
714 up->dcycles |= 1; in irig_base()
715 switch(up->pulse) { in irig_base()
718 irig_baud(peer, up->dcycles); in irig_base()
719 if (env < up->envmin) in irig_base()
720 up->envmin = env; in irig_base()
721 up->slice = (up->envmax + up->envmin) / 2; in irig_base()
722 up->envmin = 1e6; up->envmax = -1e6; in irig_base()
726 up->envmax = env; in irig_base()
730 if (env > up->envmax) in irig_base()
731 up->envmax = env; in irig_base()
735 up->envmin = env; in irig_base()
750 struct irigunit *up; in irig_baud() local
755 up = pp->unitptr; in irig_baud()
764 up->exing = -up->yxing; in irig_baud()
765 if (abs(up->envxing - up->envphase) <= 1) { in irig_baud()
766 up->tcount++; in irig_baud()
767 if (up->tcount > 20 * up->tc) { in irig_baud()
768 up->tc++; in irig_baud()
769 if (up->tc > MAXTC) in irig_baud()
770 up->tc = MAXTC; in irig_baud()
771 up->tcount = 0; in irig_baud()
772 up->envxing = up->envphase; in irig_baud()
774 up->exing -= up->envxing - up->envphase; in irig_baud()
777 up->tcount = 0; in irig_baud()
778 up->envxing = up->envphase; in irig_baud()
786 up->prvstamp = up->chrstamp; in irig_baud()
787 dtemp = up->decim * (up->exing / SECOND) + up->fdelay; in irig_baud()
789 up->chrstamp = up->timestamp; in irig_baud()
790 L_SUB(&up->chrstamp, &ltemp); in irig_baud()
798 switch (up->dcycles & 0xff) { in irig_baud()
819 up->errflg |= IRIG_ERR_DECODE; in irig_baud()
839 struct irigunit *up; in irig_decode() local
851 up = pp->unitptr; in irig_decode()
856 up->bits >>= 1; in irig_decode()
858 up->bits |= 0x200; in irig_decode()
859 } else if (bit == BITP && up->lastbit == BITP) { in irig_decode()
868 if (up->frmcnt != 1) in irig_decode()
869 up->errflg |= IRIG_ERR_SYNCH; in irig_decode()
870 up->frmcnt = 1; in irig_decode()
871 up->refstamp = up->prvstamp; in irig_decode()
873 up->lastbit = bit; in irig_decode()
874 if (up->frmcnt % SUBFLD == 0) { in irig_decode()
881 temp = up->bits; in irig_decode()
882 if (up->frmcnt == 10) in irig_decode()
884 if (up->xptr >= 2) { in irig_decode()
885 up->timecode[--up->xptr] = hexchar[temp & 0xf]; in irig_decode()
886 up->timecode[--up->xptr] = hexchar[(temp >> 5) & in irig_decode()
889 if (up->frmcnt == 0) { in irig_decode()
904 up->xptr = 2 * SUBFLD; in irig_decode()
905 if (sscanf((char *)up->timecode, in irig_decode()
912 up->second = (up->second + up->decim) % 60; in irig_decode()
928 up->errflg |= IRIG_ERR_SIGERR; in irig_decode()
929 if (pp->second != up->second) in irig_decode()
930 up->errflg |= IRIG_ERR_CHECK; in irig_decode()
931 up->second = pp->second; in irig_decode()
938 if (up->errflg == 0 && up->tc == MAXTC) { in irig_decode()
940 pp->lastrec = up->refstamp; in irig_decode()
947 up->errflg, pp->year, pp->day, in irig_decode()
949 up->maxsignal, up->gain, up->modndx, in irig_decode()
950 up->tc, up->exing * 1e6 / SECOND, up->freq * in irig_decode()
953 up->errflg = 0; in irig_decode()
965 up->frmcnt = (up->frmcnt + 1) % FIELD; in irig_decode()
972 * This routine sweeps up the timecode updates since the last poll. For
1018 struct irigunit *up; in irig_gain() local
1021 up = pp->unitptr; in irig_gain()
1028 if (up->maxsignal < MINAMP) { in irig_gain()
1029 up->gain += 4; in irig_gain()
1030 if (up->gain > MAXGAIN) in irig_gain()
1031 up->gain = MAXGAIN; in irig_gain()
1032 } else if (up->maxsignal > MAXAMP) { in irig_gain()
1033 up->gain -= 4; in irig_gain()
1034 if (up->gain < 0) in irig_gain()
1035 up->gain = 0; in irig_gain()
1037 audio_gain(up->gain, up->mongain, up->port); in irig_gain()