|
@@ -220,173 +220,50 @@ static u32 af913_div(u32 a, u32 b, u32 x)
|
|
|
|
|
|
static int af9013_set_coeff(struct af9013_state *state, fe_bandwidth_t bw)
|
|
static int af9013_set_coeff(struct af9013_state *state, fe_bandwidth_t bw)
|
|
{
|
|
{
|
|
- int ret = 0;
|
|
|
|
- u8 i = 0;
|
|
|
|
|
|
+ int ret, i, found;
|
|
u8 buf[24];
|
|
u8 buf[24];
|
|
- u32 uninitialized_var(ns_coeff1_2048nu);
|
|
|
|
- u32 uninitialized_var(ns_coeff1_8191nu);
|
|
|
|
- u32 uninitialized_var(ns_coeff1_8192nu);
|
|
|
|
- u32 uninitialized_var(ns_coeff1_8193nu);
|
|
|
|
- u32 uninitialized_var(ns_coeff2_2k);
|
|
|
|
- u32 uninitialized_var(ns_coeff2_8k);
|
|
|
|
-
|
|
|
|
deb_info("%s: adc_clock:%d bw:%d\n", __func__,
|
|
deb_info("%s: adc_clock:%d bw:%d\n", __func__,
|
|
state->config.adc_clock, bw);
|
|
state->config.adc_clock, bw);
|
|
|
|
|
|
- switch (state->config.adc_clock) {
|
|
|
|
- case 28800: /* 28.800 MHz */
|
|
|
|
- switch (bw) {
|
|
|
|
- case BANDWIDTH_6_MHZ:
|
|
|
|
- ns_coeff1_2048nu = 0x01e79e7a;
|
|
|
|
- ns_coeff1_8191nu = 0x0079eb6e;
|
|
|
|
- ns_coeff1_8192nu = 0x0079e79e;
|
|
|
|
- ns_coeff1_8193nu = 0x0079e3cf;
|
|
|
|
- ns_coeff2_2k = 0x00f3cf3d;
|
|
|
|
- ns_coeff2_8k = 0x003cf3cf;
|
|
|
|
- break;
|
|
|
|
- case BANDWIDTH_7_MHZ:
|
|
|
|
- ns_coeff1_2048nu = 0x0238e38e;
|
|
|
|
- ns_coeff1_8191nu = 0x008e3d55;
|
|
|
|
- ns_coeff1_8192nu = 0x008e38e4;
|
|
|
|
- ns_coeff1_8193nu = 0x008e3472;
|
|
|
|
- ns_coeff2_2k = 0x011c71c7;
|
|
|
|
- ns_coeff2_8k = 0x00471c72;
|
|
|
|
- break;
|
|
|
|
- case BANDWIDTH_8_MHZ:
|
|
|
|
- ns_coeff1_2048nu = 0x028a28a3;
|
|
|
|
- ns_coeff1_8191nu = 0x00a28f3d;
|
|
|
|
- ns_coeff1_8192nu = 0x00a28a29;
|
|
|
|
- ns_coeff1_8193nu = 0x00a28514;
|
|
|
|
- ns_coeff2_2k = 0x01451451;
|
|
|
|
- ns_coeff2_8k = 0x00514514;
|
|
|
|
- break;
|
|
|
|
- default:
|
|
|
|
- ret = -EINVAL;
|
|
|
|
- }
|
|
|
|
- break;
|
|
|
|
- case 20480: /* 20.480 MHz */
|
|
|
|
- switch (bw) {
|
|
|
|
- case BANDWIDTH_6_MHZ:
|
|
|
|
- ns_coeff1_2048nu = 0x02adb6dc;
|
|
|
|
- ns_coeff1_8191nu = 0x00ab7313;
|
|
|
|
- ns_coeff1_8192nu = 0x00ab6db7;
|
|
|
|
- ns_coeff1_8193nu = 0x00ab685c;
|
|
|
|
- ns_coeff2_2k = 0x0156db6e;
|
|
|
|
- ns_coeff2_8k = 0x0055b6dc;
|
|
|
|
- break;
|
|
|
|
- case BANDWIDTH_7_MHZ:
|
|
|
|
- ns_coeff1_2048nu = 0x03200001;
|
|
|
|
- ns_coeff1_8191nu = 0x00c80640;
|
|
|
|
- ns_coeff1_8192nu = 0x00c80000;
|
|
|
|
- ns_coeff1_8193nu = 0x00c7f9c0;
|
|
|
|
- ns_coeff2_2k = 0x01900000;
|
|
|
|
- ns_coeff2_8k = 0x00640000;
|
|
|
|
- break;
|
|
|
|
- case BANDWIDTH_8_MHZ:
|
|
|
|
- ns_coeff1_2048nu = 0x03924926;
|
|
|
|
- ns_coeff1_8191nu = 0x00e4996e;
|
|
|
|
- ns_coeff1_8192nu = 0x00e49249;
|
|
|
|
- ns_coeff1_8193nu = 0x00e48b25;
|
|
|
|
- ns_coeff2_2k = 0x01c92493;
|
|
|
|
- ns_coeff2_8k = 0x00724925;
|
|
|
|
- break;
|
|
|
|
- default:
|
|
|
|
- ret = -EINVAL;
|
|
|
|
- }
|
|
|
|
- break;
|
|
|
|
- case 28000: /* 28.000 MHz */
|
|
|
|
- switch (bw) {
|
|
|
|
- case BANDWIDTH_6_MHZ:
|
|
|
|
- ns_coeff1_2048nu = 0x01f58d10;
|
|
|
|
- ns_coeff1_8191nu = 0x007d672f;
|
|
|
|
- ns_coeff1_8192nu = 0x007d6344;
|
|
|
|
- ns_coeff1_8193nu = 0x007d5f59;
|
|
|
|
- ns_coeff2_2k = 0x00fac688;
|
|
|
|
- ns_coeff2_8k = 0x003eb1a2;
|
|
|
|
- break;
|
|
|
|
- case BANDWIDTH_7_MHZ:
|
|
|
|
- ns_coeff1_2048nu = 0x02492492;
|
|
|
|
- ns_coeff1_8191nu = 0x00924db7;
|
|
|
|
- ns_coeff1_8192nu = 0x00924925;
|
|
|
|
- ns_coeff1_8193nu = 0x00924492;
|
|
|
|
- ns_coeff2_2k = 0x01249249;
|
|
|
|
- ns_coeff2_8k = 0x00492492;
|
|
|
|
|
|
+ /* lookup coeff from table */
|
|
|
|
+ for (i = 0, found = 0; i < ARRAY_SIZE(coeff_table); i++) {
|
|
|
|
+ if (coeff_table[i].adc_clock == state->config.adc_clock &&
|
|
|
|
+ coeff_table[i].bw == bw) {
|
|
|
|
+ found = 1;
|
|
break;
|
|
break;
|
|
- case BANDWIDTH_8_MHZ:
|
|
|
|
- ns_coeff1_2048nu = 0x029cbc15;
|
|
|
|
- ns_coeff1_8191nu = 0x00a7343f;
|
|
|
|
- ns_coeff1_8192nu = 0x00a72f05;
|
|
|
|
- ns_coeff1_8193nu = 0x00a729cc;
|
|
|
|
- ns_coeff2_2k = 0x014e5e0a;
|
|
|
|
- ns_coeff2_8k = 0x00539783;
|
|
|
|
- break;
|
|
|
|
- default:
|
|
|
|
- ret = -EINVAL;
|
|
|
|
- }
|
|
|
|
- break;
|
|
|
|
- case 25000: /* 25.000 MHz */
|
|
|
|
- switch (bw) {
|
|
|
|
- case BANDWIDTH_6_MHZ:
|
|
|
|
- ns_coeff1_2048nu = 0x0231bcb5;
|
|
|
|
- ns_coeff1_8191nu = 0x008c7391;
|
|
|
|
- ns_coeff1_8192nu = 0x008c6f2d;
|
|
|
|
- ns_coeff1_8193nu = 0x008c6aca;
|
|
|
|
- ns_coeff2_2k = 0x0118de5b;
|
|
|
|
- ns_coeff2_8k = 0x00463797;
|
|
|
|
- break;
|
|
|
|
- case BANDWIDTH_7_MHZ:
|
|
|
|
- ns_coeff1_2048nu = 0x028f5c29;
|
|
|
|
- ns_coeff1_8191nu = 0x00a3dc29;
|
|
|
|
- ns_coeff1_8192nu = 0x00a3d70a;
|
|
|
|
- ns_coeff1_8193nu = 0x00a3d1ec;
|
|
|
|
- ns_coeff2_2k = 0x0147ae14;
|
|
|
|
- ns_coeff2_8k = 0x0051eb85;
|
|
|
|
- break;
|
|
|
|
- case BANDWIDTH_8_MHZ:
|
|
|
|
- ns_coeff1_2048nu = 0x02ecfb9d;
|
|
|
|
- ns_coeff1_8191nu = 0x00bb44c1;
|
|
|
|
- ns_coeff1_8192nu = 0x00bb3ee7;
|
|
|
|
- ns_coeff1_8193nu = 0x00bb390d;
|
|
|
|
- ns_coeff2_2k = 0x01767dce;
|
|
|
|
- ns_coeff2_8k = 0x005d9f74;
|
|
|
|
- break;
|
|
|
|
- default:
|
|
|
|
- ret = -EINVAL;
|
|
|
|
}
|
|
}
|
|
- break;
|
|
|
|
- default:
|
|
|
|
- err("invalid xtal");
|
|
|
|
- return -EINVAL;
|
|
|
|
}
|
|
}
|
|
- if (ret) {
|
|
|
|
- err("invalid bandwidth");
|
|
|
|
- return ret;
|
|
|
|
|
|
+
|
|
|
|
+ if (!found) {
|
|
|
|
+ err("invalid bw or clock");
|
|
|
|
+ ret = -EINVAL;
|
|
|
|
+ goto error;
|
|
}
|
|
}
|
|
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_2048nu & 0x03000000) >> 24);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_2048nu & 0x00ff0000) >> 16);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_2048nu & 0x0000ff00) >> 8);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_2048nu & 0x000000ff));
|
|
|
|
- buf[i++] = (u8) ((ns_coeff2_2k & 0x01c00000) >> 22);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff2_2k & 0x003fc000) >> 14);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff2_2k & 0x00003fc0) >> 6);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff2_2k & 0x0000003f));
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_8191nu & 0x03000000) >> 24);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_8191nu & 0x00ffc000) >> 16);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_8191nu & 0x0000ff00) >> 8);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_8191nu & 0x000000ff));
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_8192nu & 0x03000000) >> 24);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_8192nu & 0x00ffc000) >> 16);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_8192nu & 0x0000ff00) >> 8);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_8192nu & 0x000000ff));
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_8193nu & 0x03000000) >> 24);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_8193nu & 0x00ffc000) >> 16);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_8193nu & 0x0000ff00) >> 8);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff1_8193nu & 0x000000ff));
|
|
|
|
- buf[i++] = (u8) ((ns_coeff2_8k & 0x01c00000) >> 22);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff2_8k & 0x003fc000) >> 14);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff2_8k & 0x00003fc0) >> 6);
|
|
|
|
- buf[i++] = (u8) ((ns_coeff2_8k & 0x0000003f));
|
|
|
|
|
|
+ buf[0] = (u8) ((coeff_table[i].ns_coeff1_2048nu & 0x03000000) >> 24);
|
|
|
|
+ buf[1] = (u8) ((coeff_table[i].ns_coeff1_2048nu & 0x00ff0000) >> 16);
|
|
|
|
+ buf[2] = (u8) ((coeff_table[i].ns_coeff1_2048nu & 0x0000ff00) >> 8);
|
|
|
|
+ buf[3] = (u8) ((coeff_table[i].ns_coeff1_2048nu & 0x000000ff));
|
|
|
|
+ buf[4] = (u8) ((coeff_table[i].ns_coeff2_2k & 0x01c00000) >> 22);
|
|
|
|
+ buf[5] = (u8) ((coeff_table[i].ns_coeff2_2k & 0x003fc000) >> 14);
|
|
|
|
+ buf[6] = (u8) ((coeff_table[i].ns_coeff2_2k & 0x00003fc0) >> 6);
|
|
|
|
+ buf[7] = (u8) ((coeff_table[i].ns_coeff2_2k & 0x0000003f));
|
|
|
|
+ buf[8] = (u8) ((coeff_table[i].ns_coeff1_8191nu & 0x03000000) >> 24);
|
|
|
|
+ buf[9] = (u8) ((coeff_table[i].ns_coeff1_8191nu & 0x00ffc000) >> 16);
|
|
|
|
+ buf[10] = (u8) ((coeff_table[i].ns_coeff1_8191nu & 0x0000ff00) >> 8);
|
|
|
|
+ buf[11] = (u8) ((coeff_table[i].ns_coeff1_8191nu & 0x000000ff));
|
|
|
|
+ buf[12] = (u8) ((coeff_table[i].ns_coeff1_8192nu & 0x03000000) >> 24);
|
|
|
|
+ buf[13] = (u8) ((coeff_table[i].ns_coeff1_8192nu & 0x00ffc000) >> 16);
|
|
|
|
+ buf[14] = (u8) ((coeff_table[i].ns_coeff1_8192nu & 0x0000ff00) >> 8);
|
|
|
|
+ buf[15] = (u8) ((coeff_table[i].ns_coeff1_8192nu & 0x000000ff));
|
|
|
|
+ buf[16] = (u8) ((coeff_table[i].ns_coeff1_8193nu & 0x03000000) >> 24);
|
|
|
|
+ buf[17] = (u8) ((coeff_table[i].ns_coeff1_8193nu & 0x00ffc000) >> 16);
|
|
|
|
+ buf[18] = (u8) ((coeff_table[i].ns_coeff1_8193nu & 0x0000ff00) >> 8);
|
|
|
|
+ buf[19] = (u8) ((coeff_table[i].ns_coeff1_8193nu & 0x000000ff));
|
|
|
|
+ buf[20] = (u8) ((coeff_table[i].ns_coeff2_8k & 0x01c00000) >> 22);
|
|
|
|
+ buf[21] = (u8) ((coeff_table[i].ns_coeff2_8k & 0x003fc000) >> 14);
|
|
|
|
+ buf[22] = (u8) ((coeff_table[i].ns_coeff2_8k & 0x00003fc0) >> 6);
|
|
|
|
+ buf[23] = (u8) ((coeff_table[i].ns_coeff2_8k & 0x0000003f));
|
|
|
|
|
|
deb_info("%s: coeff:", __func__);
|
|
deb_info("%s: coeff:", __func__);
|
|
debug_dump(buf, sizeof(buf), deb_info);
|
|
debug_dump(buf, sizeof(buf), deb_info);
|
|
@@ -398,6 +275,7 @@ static int af9013_set_coeff(struct af9013_state *state, fe_bandwidth_t bw)
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+error:
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|