sm_hapn4800.c

MIZI Research, Inc.发布的嵌入式Linux内核源码

						   st->dcd_sum2) < 0);
			st->dcd_sum2 = st->dcd_sum1;
			st->dcd_sum1 = st->dcd_sum0;
			st->dcd_sum0 = 2; /* slight bias */
			st->dcd_time = 240;
		}
		if (st->bit_pll >= 0x10000) {
			st->bit_pll &= 0xffff;
			st->last_bit2 = st->last_bit;
			if (curst < 0)
				st->last_bit = 0;
			else if (curst > 0)
				st->last_bit = 1;
			st->shreg >>= 1;
			st->shreg |= ((st->last_bit ^ st->last_bit2 ^ 1) & 1) << 16;
			if (st->shreg & 1) {
				hdlcdrv_putbits(&sm->hdrv, st->shreg >> 1);
				st->shreg = 0x10000;
			}
			diag_trigger(sm);
		}
		diag_add_one(sm, inv);
	}
}

/* --------------------------------------------------------------------- */

static void demodulator_hapn4800_10_s16(struct sm_state *sm, const short *buf, unsigned int buflen)
{
	struct demod_state_hapn48 *st = (struct demod_state_hapn48 *)(&sm->d);
	static const int pll_corr[2] = { -0x800, 0x800 };
	int curst, cursync;
	int inv;

	for (; buflen > 0; buflen--, buf++) {
		inv = buf[-2];
		st->lvlhi = (st->lvlhi * 65309) >> 16; /* decay */
		st->lvllo = (st->lvllo * 65309) >> 16; /* decay */
		if (inv > st->lvlhi)
			st->lvlhi = inv;
		if (inv < st->lvllo)
			st->lvllo = inv;
		if (buflen & 1)
			st->dcd_shreg <<= 1;
		st->bit_pll += 0x199a;
		curst = cursync = 0;
		if (inv > st->lvlhi >> 1) {
			curst = 1;
			cursync = (buf[-2] > buf[-1] && buf[-2] > buf[-3] &&
				   buf[-2] > buf[-0] && buf[-2] > buf[-4]);
		} else if (inv < st->lvllo >> 1) {
			curst = -1;
			cursync = (buf[-2] < buf[-1] && buf[-2] < buf[-3] &&
				   buf[-2] < buf[-0] && buf[-2] < buf[-4]);
		}
		if (cursync) {
			st->dcd_shreg |= cursync;
			st->bit_pll += pll_corr[((st->bit_pll - 0x8000u) & 0xffffu) < 0x8ccdu];
			st->dcd_sum0 += 16 * hweight32(st->dcd_shreg & 0x18c6318c) - 
				hweight32(st->dcd_shreg & 0xe739ce70);
		}
		hdlcdrv_channelbit(&sm->hdrv, cursync);
		if ((--st->dcd_time) <= 0) {
			hdlcdrv_setdcd(&sm->hdrv, (st->dcd_sum0 + 
						   st->dcd_sum1 + 
						   st->dcd_sum2) < 0);
			st->dcd_sum2 = st->dcd_sum1;
			st->dcd_sum1 = st->dcd_sum0;
			st->dcd_sum0 = 2; /* slight bias */
			st->dcd_time = 240;
		}
		if (st->bit_pll >= 0x10000) {
			st->bit_pll &= 0xffff;
			st->last_bit2 = st->last_bit;
			if (curst < 0)
				st->last_bit = 0;
			else if (curst > 0)
				st->last_bit = 1;
			st->shreg >>= 1;
			st->shreg |= ((st->last_bit ^ st->last_bit2 ^ 1) & 1) << 16;
			if (st->shreg & 1) {
				hdlcdrv_putbits(&sm->hdrv, st->shreg >> 1);
				st->shreg = 0x10000;
			}
			diag_trigger(sm);
		}
		diag_add_one(sm, inv);
	}
}

/* --------------------------------------------------------------------- */

static void demodulator_hapn4800_8_u8(struct sm_state *sm, const unsigned char *buf, unsigned int buflen)
{
	struct demod_state_hapn48 *st = (struct demod_state_hapn48 *)(&sm->d);
	static const int pll_corr[2] = { -0x800, 0x800 };
	int curst, cursync;
	int inv;

	for (; buflen > 0; buflen--, buf++) {
		inv = ((int)(buf[-2])-0x80) << 8;
		st->lvlhi = (st->lvlhi * 65309) >> 16; /* decay */
		st->lvllo = (st->lvllo * 65309) >> 16; /* decay */
		if (inv > st->lvlhi)
			st->lvlhi = inv;
		if (inv < st->lvllo)
			st->lvllo = inv;
		if (buflen & 1)
			st->dcd_shreg <<= 1;
		st->bit_pll += 0x2000;
		curst = cursync = 0;
		if (inv > st->lvlhi >> 1) {
			curst = 1;
			cursync = (buf[-2] > buf[-1] && buf[-2] > buf[-3] &&
				   buf[-2] > buf[-0] && buf[-2] > buf[-4]);
		} else if (inv < st->lvllo >> 1) {
			curst = -1;
			cursync = (buf[-2] < buf[-1] && buf[-2] < buf[-3] &&
				   buf[-2] < buf[-0] && buf[-2] < buf[-4]);
		}
		if (cursync) {
			st->dcd_shreg |= cursync;
			st->bit_pll += pll_corr[((st->bit_pll - 0x8000u) & 0xffffu) < 0x9000u];
			st->dcd_sum0 += 16 * hweight32(st->dcd_shreg & 0x44444444) - 
				hweight32(st->dcd_shreg & 0xbbbbbbbb);
		}
		hdlcdrv_channelbit(&sm->hdrv, cursync);
		if ((--st->dcd_time) <= 0) {
			hdlcdrv_setdcd(&sm->hdrv, (st->dcd_sum0 + 
						   st->dcd_sum1 + 
						   st->dcd_sum2) < 0);
			st->dcd_sum2 = st->dcd_sum1;
			st->dcd_sum1 = st->dcd_sum0;
			st->dcd_sum0 = 2; /* slight bias */
			st->dcd_time = 240;
		}
		if (st->bit_pll >= 0x10000) {
			st->bit_pll &= 0xffff;
			st->last_bit2 = st->last_bit;
			if (curst < 0)
				st->last_bit = 0;
			else if (curst > 0)
				st->last_bit = 1;
			st->shreg >>= 1;
			st->shreg |= ((st->last_bit ^ st->last_bit2 ^ 1) & 1) << 16;
			if (st->shreg & 1) {
				hdlcdrv_putbits(&sm->hdrv, st->shreg >> 1);
				st->shreg = 0x10000;
			}
			diag_trigger(sm);
		}
		diag_add_one(sm, inv);
	}
}

/* --------------------------------------------------------------------- */

static void demodulator_hapn4800_8_s16(struct sm_state *sm, const short *buf, unsigned int buflen)
{
	struct demod_state_hapn48 *st = (struct demod_state_hapn48 *)(&sm->d);
	static const int pll_corr[2] = { -0x800, 0x800 };
	int curst, cursync;
	int inv;

	for (; buflen > 0; buflen--, buf++) {
		inv = buf[-2];
		st->lvlhi = (st->lvlhi * 65309) >> 16; /* decay */
		st->lvllo = (st->lvllo * 65309) >> 16; /* decay */
		if (inv > st->lvlhi)
			st->lvlhi = inv;
		if (inv < st->lvllo)
			st->lvllo = inv;
		if (buflen & 1)
			st->dcd_shreg <<= 1;
		st->bit_pll += 0x2000;
		curst = cursync = 0;
		if (inv > st->lvlhi >> 1) {
			curst = 1;
			cursync = (buf[-2] > buf[-1] && buf[-2] > buf[-3] &&
				   buf[-2] > buf[-0] && buf[-2] > buf[-4]);
		} else if (inv < st->lvllo >> 1) {
			curst = -1;
			cursync = (buf[-2] < buf[-1] && buf[-2] < buf[-3] &&
				   buf[-2] < buf[-0] && buf[-2] < buf[-4]);
		}
		if (cursync) {
			st->dcd_shreg |= cursync;
			st->bit_pll += pll_corr[((st->bit_pll - 0x8000u) & 0xffffu) < 0x9000u];
			st->dcd_sum0 += 16 * hweight32(st->dcd_shreg & 0x44444444) - 
				hweight32(st->dcd_shreg & 0xbbbbbbbb);
		}
		hdlcdrv_channelbit(&sm->hdrv, cursync);
		if ((--st->dcd_time) <= 0) {
			hdlcdrv_setdcd(&sm->hdrv, (st->dcd_sum0 + 
						   st->dcd_sum1 + 
						   st->dcd_sum2) < 0);
			st->dcd_sum2 = st->dcd_sum1;
			st->dcd_sum1 = st->dcd_sum0;
			st->dcd_sum0 = 2; /* slight bias */
			st->dcd_time = 240;
		}
		if (st->bit_pll >= 0x10000) {
			st->bit_pll &= 0xffff;
			st->last_bit2 = st->last_bit;
			if (curst < 0)
				st->last_bit = 0;
			else if (curst > 0)
				st->last_bit = 1;
			st->shreg >>= 1;
			st->shreg |= ((st->last_bit ^ st->last_bit2 ^ 1) & 1) << 16;
			if (st->shreg & 1) {
				hdlcdrv_putbits(&sm->hdrv, st->shreg >> 1);
				st->shreg = 0x10000;
			}
			diag_trigger(sm);
		}
		diag_add_one(sm, inv);
	}
}

/* --------------------------------------------------------------------- */

static void demod_init_hapn4800(struct sm_state *sm)
{
	struct demod_state_hapn48 *st = (struct demod_state_hapn48 *)(&sm->d);

	st->dcd_time = 120;
	st->dcd_sum0 = 2;	
}

/* --------------------------------------------------------------------- */

const struct modem_tx_info sm_hapn4800_8_tx = {
	"hapn4800", sizeof(struct mod_state_hapn48), 38400, 4800, 
	modulator_hapn4800_8_u8, modulator_hapn4800_8_s16, NULL
};

const struct modem_rx_info sm_hapn4800_8_rx = {
	"hapn4800", sizeof(struct demod_state_hapn48), 38400, 4800, 5, 8, 
	demodulator_hapn4800_8_u8, demodulator_hapn4800_8_s16, demod_init_hapn4800
};

/* --------------------------------------------------------------------- */

const struct modem_tx_info sm_hapn4800_10_tx = {
	"hapn4800", sizeof(struct mod_state_hapn48), 48000, 4800,
	modulator_hapn4800_10_u8, modulator_hapn4800_10_s16, NULL
};

const struct modem_rx_info sm_hapn4800_10_rx = {
	"hapn4800", sizeof(struct demod_state_hapn48), 48000, 4800, 5, 10, 
	demodulator_hapn4800_10_u8, demodulator_hapn4800_10_s16, demod_init_hapn4800
};

/* --------------------------------------------------------------------- */

const struct modem_tx_info sm_hapn4800_pm8_tx = {
	"hapn4800pm", sizeof(struct mod_state_hapn48), 38400, 4800, 
	modulator_hapn4800_pm8_u8, modulator_hapn4800_pm8_s16, NULL
};

const struct modem_rx_info sm_hapn4800_pm8_rx = {
	"hapn4800pm", sizeof(struct demod_state_hapn48), 38400, 4800, 5, 8, 
	demodulator_hapn4800_8_u8, demodulator_hapn4800_8_s16, demod_init_hapn4800
};

/* --------------------------------------------------------------------- */

const struct modem_tx_info sm_hapn4800_pm10_tx = {
	"hapn4800pm", sizeof(struct mod_state_hapn48), 48000, 4800,
	modulator_hapn4800_pm10_u8, modulator_hapn4800_pm10_s16, NULL
};

const struct modem_rx_info sm_hapn4800_pm10_rx = {
	"hapn4800pm", sizeof(struct demod_state_hapn48), 48000, 4800, 5, 10,
	demodulator_hapn4800_10_u8, demodulator_hapn4800_10_s16, demod_init_hapn4800
};

/* --------------------------------------------------------------------- */