1*638691a0SAndroid Build Coastguard Worker /* K=15 r=1/6 Viterbi decoder with optional Intel or PowerPC SIMD
2*638691a0SAndroid Build Coastguard Worker * Copyright Feb 2004, Phil Karn, KA9Q
3*638691a0SAndroid Build Coastguard Worker */
4*638691a0SAndroid Build Coastguard Worker #include <stdio.h>
5*638691a0SAndroid Build Coastguard Worker #include <stdlib.h>
6*638691a0SAndroid Build Coastguard Worker #include <memory.h>
7*638691a0SAndroid Build Coastguard Worker #include "fec.h"
8*638691a0SAndroid Build Coastguard Worker
9*638691a0SAndroid Build Coastguard Worker /* Create a new instance of a Viterbi decoder */
create_viterbi615(int len)10*638691a0SAndroid Build Coastguard Worker void *create_viterbi615(int len){
11*638691a0SAndroid Build Coastguard Worker
12*638691a0SAndroid Build Coastguard Worker find_cpu_mode();
13*638691a0SAndroid Build Coastguard Worker
14*638691a0SAndroid Build Coastguard Worker switch(Cpu_mode){
15*638691a0SAndroid Build Coastguard Worker case PORT:
16*638691a0SAndroid Build Coastguard Worker default:
17*638691a0SAndroid Build Coastguard Worker return create_viterbi615_port(len);
18*638691a0SAndroid Build Coastguard Worker #ifdef __VEC__
19*638691a0SAndroid Build Coastguard Worker case ALTIVEC:
20*638691a0SAndroid Build Coastguard Worker return create_viterbi615_av(len);
21*638691a0SAndroid Build Coastguard Worker #endif
22*638691a0SAndroid Build Coastguard Worker #ifdef __i386__
23*638691a0SAndroid Build Coastguard Worker case MMX:
24*638691a0SAndroid Build Coastguard Worker return create_viterbi615_mmx(len);
25*638691a0SAndroid Build Coastguard Worker case SSE:
26*638691a0SAndroid Build Coastguard Worker return create_viterbi615_sse(len);
27*638691a0SAndroid Build Coastguard Worker case SSE2:
28*638691a0SAndroid Build Coastguard Worker return create_viterbi615_sse2(len);
29*638691a0SAndroid Build Coastguard Worker #endif
30*638691a0SAndroid Build Coastguard Worker }
31*638691a0SAndroid Build Coastguard Worker }
32*638691a0SAndroid Build Coastguard Worker
set_viterbi615_polynomial(int polys[6])33*638691a0SAndroid Build Coastguard Worker void set_viterbi615_polynomial(int polys[6]){
34*638691a0SAndroid Build Coastguard Worker
35*638691a0SAndroid Build Coastguard Worker switch(Cpu_mode){
36*638691a0SAndroid Build Coastguard Worker case PORT:
37*638691a0SAndroid Build Coastguard Worker default:
38*638691a0SAndroid Build Coastguard Worker set_viterbi615_polynomial_port(polys);
39*638691a0SAndroid Build Coastguard Worker break;
40*638691a0SAndroid Build Coastguard Worker #ifdef __VEC__
41*638691a0SAndroid Build Coastguard Worker case ALTIVEC:
42*638691a0SAndroid Build Coastguard Worker set_viterbi615_polynomial_av(polys);
43*638691a0SAndroid Build Coastguard Worker break;
44*638691a0SAndroid Build Coastguard Worker #endif
45*638691a0SAndroid Build Coastguard Worker #ifdef __i386__
46*638691a0SAndroid Build Coastguard Worker case MMX:
47*638691a0SAndroid Build Coastguard Worker set_viterbi615_polynomial_mmx(polys);
48*638691a0SAndroid Build Coastguard Worker break;
49*638691a0SAndroid Build Coastguard Worker case SSE:
50*638691a0SAndroid Build Coastguard Worker set_viterbi615_polynomial_sse(polys);
51*638691a0SAndroid Build Coastguard Worker break;
52*638691a0SAndroid Build Coastguard Worker case SSE2:
53*638691a0SAndroid Build Coastguard Worker set_viterbi615_polynomial_sse2(polys);
54*638691a0SAndroid Build Coastguard Worker break;
55*638691a0SAndroid Build Coastguard Worker #endif
56*638691a0SAndroid Build Coastguard Worker }
57*638691a0SAndroid Build Coastguard Worker }
58*638691a0SAndroid Build Coastguard Worker
59*638691a0SAndroid Build Coastguard Worker /* Initialize Viterbi decoder for start of new frame */
init_viterbi615(void * p,int starting_state)60*638691a0SAndroid Build Coastguard Worker int init_viterbi615(void *p,int starting_state){
61*638691a0SAndroid Build Coastguard Worker switch(Cpu_mode){
62*638691a0SAndroid Build Coastguard Worker case PORT:
63*638691a0SAndroid Build Coastguard Worker default:
64*638691a0SAndroid Build Coastguard Worker return init_viterbi615_port(p,starting_state);
65*638691a0SAndroid Build Coastguard Worker #ifdef __VEC__
66*638691a0SAndroid Build Coastguard Worker case ALTIVEC:
67*638691a0SAndroid Build Coastguard Worker return init_viterbi615_av(p,starting_state);
68*638691a0SAndroid Build Coastguard Worker #endif
69*638691a0SAndroid Build Coastguard Worker #ifdef __i386__
70*638691a0SAndroid Build Coastguard Worker case MMX:
71*638691a0SAndroid Build Coastguard Worker return init_viterbi615_mmx(p,starting_state);
72*638691a0SAndroid Build Coastguard Worker case SSE:
73*638691a0SAndroid Build Coastguard Worker return init_viterbi615_sse(p,starting_state);
74*638691a0SAndroid Build Coastguard Worker case SSE2:
75*638691a0SAndroid Build Coastguard Worker return init_viterbi615_sse2(p,starting_state);
76*638691a0SAndroid Build Coastguard Worker #endif
77*638691a0SAndroid Build Coastguard Worker }
78*638691a0SAndroid Build Coastguard Worker }
79*638691a0SAndroid Build Coastguard Worker
80*638691a0SAndroid Build Coastguard Worker /* Viterbi chainback */
chainback_viterbi615(void * p,unsigned char * data,unsigned int nbits,unsigned int endstate)81*638691a0SAndroid Build Coastguard Worker int chainback_viterbi615(
82*638691a0SAndroid Build Coastguard Worker void *p,
83*638691a0SAndroid Build Coastguard Worker unsigned char *data, /* Decoded output data */
84*638691a0SAndroid Build Coastguard Worker unsigned int nbits, /* Number of data bits */
85*638691a0SAndroid Build Coastguard Worker unsigned int endstate){ /* Terminal encoder state */
86*638691a0SAndroid Build Coastguard Worker
87*638691a0SAndroid Build Coastguard Worker switch(Cpu_mode){
88*638691a0SAndroid Build Coastguard Worker case PORT:
89*638691a0SAndroid Build Coastguard Worker default:
90*638691a0SAndroid Build Coastguard Worker return chainback_viterbi615_port(p,data,nbits,endstate);
91*638691a0SAndroid Build Coastguard Worker #ifdef __VEC__
92*638691a0SAndroid Build Coastguard Worker case ALTIVEC:
93*638691a0SAndroid Build Coastguard Worker return chainback_viterbi615_av(p,data,nbits,endstate);
94*638691a0SAndroid Build Coastguard Worker #endif
95*638691a0SAndroid Build Coastguard Worker #ifdef __i386__
96*638691a0SAndroid Build Coastguard Worker case MMX:
97*638691a0SAndroid Build Coastguard Worker return chainback_viterbi615_mmx(p,data,nbits,endstate);
98*638691a0SAndroid Build Coastguard Worker case SSE:
99*638691a0SAndroid Build Coastguard Worker return chainback_viterbi615_sse(p,data,nbits,endstate);
100*638691a0SAndroid Build Coastguard Worker case SSE2:
101*638691a0SAndroid Build Coastguard Worker return chainback_viterbi615_sse2(p,data,nbits,endstate);
102*638691a0SAndroid Build Coastguard Worker #endif
103*638691a0SAndroid Build Coastguard Worker }
104*638691a0SAndroid Build Coastguard Worker }
105*638691a0SAndroid Build Coastguard Worker
106*638691a0SAndroid Build Coastguard Worker /* Delete instance of a Viterbi decoder */
delete_viterbi615(void * p)107*638691a0SAndroid Build Coastguard Worker void delete_viterbi615(void *p){
108*638691a0SAndroid Build Coastguard Worker switch(Cpu_mode){
109*638691a0SAndroid Build Coastguard Worker case PORT:
110*638691a0SAndroid Build Coastguard Worker default:
111*638691a0SAndroid Build Coastguard Worker delete_viterbi615_port(p);
112*638691a0SAndroid Build Coastguard Worker break;
113*638691a0SAndroid Build Coastguard Worker #ifdef __VEC__
114*638691a0SAndroid Build Coastguard Worker case ALTIVEC:
115*638691a0SAndroid Build Coastguard Worker delete_viterbi615_av(p);
116*638691a0SAndroid Build Coastguard Worker break;
117*638691a0SAndroid Build Coastguard Worker #endif
118*638691a0SAndroid Build Coastguard Worker #ifdef __i386__
119*638691a0SAndroid Build Coastguard Worker case MMX:
120*638691a0SAndroid Build Coastguard Worker delete_viterbi615_mmx(p);
121*638691a0SAndroid Build Coastguard Worker break;
122*638691a0SAndroid Build Coastguard Worker case SSE:
123*638691a0SAndroid Build Coastguard Worker delete_viterbi615_sse(p);
124*638691a0SAndroid Build Coastguard Worker break;
125*638691a0SAndroid Build Coastguard Worker case SSE2:
126*638691a0SAndroid Build Coastguard Worker delete_viterbi615_sse2(p);
127*638691a0SAndroid Build Coastguard Worker break;
128*638691a0SAndroid Build Coastguard Worker #endif
129*638691a0SAndroid Build Coastguard Worker }
130*638691a0SAndroid Build Coastguard Worker }
131*638691a0SAndroid Build Coastguard Worker
132*638691a0SAndroid Build Coastguard Worker /* Update decoder with a block of demodulated symbols
133*638691a0SAndroid Build Coastguard Worker * Note that nbits is the number of decoded data bits, not the number
134*638691a0SAndroid Build Coastguard Worker * of symbols!
135*638691a0SAndroid Build Coastguard Worker */
update_viterbi615_blk(void * p,unsigned char syms[],int nbits)136*638691a0SAndroid Build Coastguard Worker int update_viterbi615_blk(void *p,unsigned char syms[],int nbits){
137*638691a0SAndroid Build Coastguard Worker switch(Cpu_mode){
138*638691a0SAndroid Build Coastguard Worker case PORT:
139*638691a0SAndroid Build Coastguard Worker default:
140*638691a0SAndroid Build Coastguard Worker return update_viterbi615_blk_port(p,syms,nbits);
141*638691a0SAndroid Build Coastguard Worker #ifdef __VEC__
142*638691a0SAndroid Build Coastguard Worker case ALTIVEC:
143*638691a0SAndroid Build Coastguard Worker return update_viterbi615_blk_av(p,syms,nbits);
144*638691a0SAndroid Build Coastguard Worker #endif
145*638691a0SAndroid Build Coastguard Worker #ifdef __i386__
146*638691a0SAndroid Build Coastguard Worker case MMX:
147*638691a0SAndroid Build Coastguard Worker return update_viterbi615_blk_mmx(p,syms,nbits);
148*638691a0SAndroid Build Coastguard Worker case SSE:
149*638691a0SAndroid Build Coastguard Worker return update_viterbi615_blk_sse(p,syms,nbits);
150*638691a0SAndroid Build Coastguard Worker case SSE2:
151*638691a0SAndroid Build Coastguard Worker return update_viterbi615_blk_sse2(p,syms,nbits);
152*638691a0SAndroid Build Coastguard Worker #endif
153*638691a0SAndroid Build Coastguard Worker }
154*638691a0SAndroid Build Coastguard Worker }
155*638691a0SAndroid Build Coastguard Worker
156