diff options
Diffstat (limited to 'ini.c')
| -rw-r--r-- | ini.c | 1773 |
1 files changed, 1773 insertions, 0 deletions
@@ -0,0 +1,1773 @@ + + +/* + * PLT utility for wireless chip supported by TI's driver wl12xx + * + * See README and COPYING for more details. + */ + +#include <sys/ioctl.h> +#include <errno.h> +#include <stdio.h> +#include <stdlib.h> +#include <string.h> +#include <sys/stat.h> +#include <fcntl.h> +#include <unistd.h> +#include <stdbool.h> +#include <limits.h> + +#include <netlink/genl/genl.h> +#include <netlink/genl/family.h> +#include <netlink/genl/ctrl.h> +#include <netlink/msg.h> +#include <netlink/attr.h> +#include <linux/wireless.h> +#include "nl80211.h" + +#include "calibrator.h" +#include "plt.h" +#include "ini.h" +#include "nvs.h" + +static char *ini_get_line(char *s, int size, FILE *stream, int *line, + char **_pos) +{ + char *pos, *end, *sstart; + + while (fgets(s, size, stream)) { + s[size - 1] = '\0'; + pos = s; + + /* Skip white space from the beginning of line. */ + while (*pos == ' ' || *pos == '\t' || *pos == '\r') + pos++; + + /* Skip comment lines and empty lines */ + if (*pos == '#' || *pos == '\n' || *pos == '\0') + continue; + + /* + * Remove # comments unless they are within a double quoted + * string. + */ + sstart = strchr(pos, '"'); + if (sstart) + sstart = strrchr(sstart + 1, '"'); + if (!sstart) + sstart = pos; + end = strchr(sstart, '#'); + if (end) + *end-- = '\0'; + else + end = pos + strlen(pos) - 1; + + /* Remove trailing white space. */ + while (end > pos && + (*end == '\n' || *end == ' ' || *end == '\t' || + *end == '\r')) + *end-- = '\0'; + + if (*pos == '\0') + continue; + + (*line)++; + + if (_pos) + *_pos = pos; + return pos; + } + + if (_pos) + *_pos = NULL; + + return NULL; +} + +static int split_line(char *line, char **name, char **value) +{ + char *pos = line; + + *value = strchr(pos, '='); + if (!*value) { + fprintf(stderr, "Wrong format of line\n"); + return 1; + } + + *name = *value; + + (*name)--; + while (**name == ' ' || **name == '\t' || **name == '\r') + (*name)--; + + *++(*name) = '\0'; + + (*value)++; + while (**value == ' ' || **value == '\t' || **value == '\r') + (*value)++; + + return 0; +} + +/* Parse array of unsigned chars */ +static int parse_uc_a(char* name, char *val, unsigned char *out, size_t exp_size) +{ + size_t i = 0; + long v; + char *endval; + + while (*val) { + /* Advance to next token */ + while (*val == ' ' || *val == ',') + val++; + + if (i >= exp_size) { + fprintf(stderr, "Too many params for %s\n", name); + return 1; + } + v = strtol(val, &endval, 16); + + if (endval == val) { + fprintf(stderr, "Syntax error parsing %s\n", name); + return 1; + } + if (v > (long) UCHAR_MAX) { + fprintf(stderr, "Overflow parsing %s\n", name); + return 1; + } + out[i++] = v; + val = endval; + } + + if(exp_size != i) { + fprintf(stderr, "Too few parameters for %s\n", name); + return 1; + } + + return 0; +} + +/* Parse array of __le16 */ +static int parse_ui_a(char* name, char *val, __le16 *out, size_t exp_size) +{ + size_t i = 0; + long v; + char *endval; + unsigned char *ptr = (unsigned char *)out; + + while (*val) { + /* Advance to next token */ + while (*val == ' ' || *val == ',') + val++; + + if (i >= exp_size) { + fprintf(stderr, "Too many params for %s\n", name); + return 1; + } + v = strtol(val, &endval, 16); + + if (endval == val) { + fprintf(stderr, "Syntax error parsing %s\n", name); + return 1; + } + if (v > (long) INT16_MAX) { + fprintf(stderr, "Overflow parsing %s\n", name); + return 1; + } + ptr[i*2] = (unsigned char) v; + ptr[(i*2)+1] = (unsigned char) (v >> 8); + i++; + + val = endval; + } + + if(exp_size != i) { + fprintf(stderr, "Too few parameters for %s\n", name); + return 1; + } + + return 0; +} + +#define COMPARE_N_ADD(temp, str, val, ptr) \ + if (strncmp(temp, str, sizeof(temp)) == 0) { \ + return parse_uc_a(temp, val, (unsigned char*) ptr, sizeof(*ptr)); \ + } + +#define COMPARE_N_ADD2(temp, str, val, ptr) \ + if (strncmp(temp, str, sizeof(temp)) == 0) { \ + return parse_ui_a(temp, val, (__le16*) ptr, sizeof(*ptr)/2); \ + } + +static int parse_general_prms(char *l, struct wl12xx_common *cmn, + struct wl12xx_ini *p) +{ + char *name, *val; + struct wl1271_ini_general_params *gp = &(p->ini1271.general_params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD("TXBiPFEMAutoDetect", l, val, + &gp->tx_bip_fem_auto_detect); + + cmn->auto_fem = gp->tx_bip_fem_auto_detect; + + COMPARE_N_ADD("TXBiPFEMManufacturer", l, val, + &gp->tx_bip_fem_manufacturer); + + COMPARE_N_ADD("RefClk", l, val, &gp->ref_clock); + + COMPARE_N_ADD("SettlingTime", l, val, &gp->settling_time); + + COMPARE_N_ADD("ClockValidOnWakeup", l, val, + &gp->clk_valid_on_wakeup); + + COMPARE_N_ADD("DC2DCMode", l, val, &gp->dc2dc_mode); + + COMPARE_N_ADD("Single_Dual_Band_Solution", l, val, + &gp->dual_mode_select); + + COMPARE_N_ADD("Settings", l, val, &gp->general_settings); + + COMPARE_N_ADD("SRState", l, val, &gp->sr_state); + + COMPARE_N_ADD("SRF1", l, val, &gp->srf1); + + COMPARE_N_ADD("SRF2", l, val, &gp->srf2); + + COMPARE_N_ADD("SRF3", l, val, &gp->srf3); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_general_prms_128x(char *l, struct wl12xx_common *cmn, + struct wl12xx_ini *p) +{ + char *name, *val; + struct wl128x_ini_general_params *gp = + &(p->ini128x.general_params); + + if (split_line(l, &name, &val)) + return 1; + + + COMPARE_N_ADD("TXBiPFEMAutoDetect", l, val, + &gp->tx_bip_fem_auto_detect); + + COMPARE_N_ADD("TXBiPFEMManufacturer", l, val, + &gp->tx_bip_fem_manufacturer); + + cmn->auto_fem = gp->tx_bip_fem_auto_detect; + + COMPARE_N_ADD("RefClk", l, val, &gp->ref_clock); + + COMPARE_N_ADD("SettlingTime", l, val, &gp->settling_time); + + COMPARE_N_ADD("ClockValidOnWakeup", l, val, &gp->clk_valid_on_wakeup); + + COMPARE_N_ADD("TCXO_Clk", l, val, &gp->tcxo_ref_clock); + + COMPARE_N_ADD("TCXO_SettlingTime", l, val, &gp->tcxo_settling_time); + + COMPARE_N_ADD("TCXO_ClockValidOnWakeup", l, val, + &gp->tcxo_valid_on_wakeup); + + COMPARE_N_ADD("TCXO_LDO_Voltage", l, val, &gp->tcxo_ldo_voltage); + + COMPARE_N_ADD("Platform_configuration", l, val, &gp->platform_conf); + + COMPARE_N_ADD("Single_Dual_Band_Solution", l, val, + &gp->dual_mode_select); + + COMPARE_N_ADD("Settings", l, val, &gp->general_settings); + + COMPARE_N_ADD("XTALItrimVal", l, val, &gp->xtal_itrim_val); + + COMPARE_N_ADD("SRState", l, val, &gp->sr_state); + + COMPARE_N_ADD("SRF1", l, val, &gp->srf1); + + COMPARE_N_ADD("SRF2", l, val, &gp->srf2); + + COMPARE_N_ADD("SRF3", l, val, &gp->srf3); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_band2_prms(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl1271_ini_band_params_2 *gp = + &(p->ini1271.stat_radio_params_2); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD("RxTraceInsertionLoss_2_4G", l, val, + &gp->rx_trace_insertion_loss); + + COMPARE_N_ADD("TXTraceLoss_2_4G", l, val, + &gp->tx_trace_loss); + + COMPARE_N_ADD("RxRssiAndProcessCompensation_2_4G", l, val, + &gp->rx_rssi_process_compens); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_band2_prms_128x(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl128x_ini_band_params_2 *gp = &(p->ini128x.stat_radio_params_2); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD("RxTraceInsertionLoss_2_4G", l, val, + &gp->rx_trace_insertion_loss); + + COMPARE_N_ADD("TxTraceLoss_2_4G", l, val, &gp->tx_trace_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_band5_prms(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl1271_ini_band_params_5 *gp = + &(p->ini1271.stat_radio_params_5); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD("RxTraceInsertionLoss_5G", l, val, + &gp->rx_trace_insertion_loss); + + COMPARE_N_ADD("TXTraceLoss_5G", l, val, + &gp->tx_trace_loss); + + COMPARE_N_ADD("RxRssiAndProcessCompensation_5G", l, val, + &gp->rx_rssi_process_compens); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_band5_prms_128x(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl128x_ini_band_params_5 *gp = &(p->ini128x.stat_radio_params_5); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD("RxTraceInsertionLoss_5G", l, val, + &gp->rx_trace_insertion_loss); + + COMPARE_N_ADD("TxTraceLoss_5G", l, val, + &gp->tx_trace_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem0_band2_prms(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl1271_ini_fem_params_2 *gp = + &(p->ini1271.dyn_radio_params_2[0].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM0_TXBiPReferencePDvoltage_2_4G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM0_TxBiPReferencePower_2_4G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM0_TxBiPOffsetdB_2_4G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM0_TxPerRatePowerLimits_2_4G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM0_TxPerRatePowerLimits_2_4G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM0_TxPerRatePowerLimits_2_4G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM0_DegradedLowToNormalThr_2_4G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM0_NormalToDegradedHighThr_2_4G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM0_TxPerChannelPowerLimits_2_4G_11b", l, val, + &gp->tx_per_chan_pwr_limits_11b); + + COMPARE_N_ADD("FEM0_TxPerChannelPowerLimits_2_4G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM0_TxPDVsRateOffsets_2_4G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM0_TxIbiasTable_2_4G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM0_RxFemInsertionLoss_2_4G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem0_band2_prms_128x(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl128x_ini_fem_params_2 *gp = + &(p->ini128x.dyn_radio_params_2[0].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM0_TxBiPReferencePDvoltage_2_4G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM0_TxBiPReferencePower_2_4G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM0_TxBiPOffsetdB_2_4G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM0_TxPerRatePowerLimits_2_4G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM0_TxPerRatePowerLimits_2_4G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM0_TxPerRatePowerLimits_2_4G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM0_DegradedLowToNormalThr_2_4G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM0_NormalToDegradedHighThr_2_4G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM0_TxPerChannelPowerLimits_2_4G_11b", l, val, + &gp->tx_per_chan_pwr_limits_11b); + + COMPARE_N_ADD("FEM0_TxPerChannelPowerLimits_2_4G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM0_TxPDVsRateOffsets_2_4G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM0_TxPDVsChannelOffsets_2_4G", l, val, + &gp->tx_pd_vs_chan_offsets); + + COMPARE_N_ADD("FEM0_TxPDVsTemperature_2_4G", l, val, + &gp->tx_pd_vs_temperature); + + COMPARE_N_ADD("FEM0_TxIbiasTable_2_4G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM0_RxFemInsertionLoss_2_4G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem1_band2_prms(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl1271_ini_fem_params_2 *gp = + &(p->ini1271.dyn_radio_params_2[1].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM1_TXBiPReferencePDvoltage_2_4G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM1_TxBiPReferencePower_2_4G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM1_TxBiPOffsetdB_2_4G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM1_TxPerRatePowerLimits_2_4G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM1_TxPerRatePowerLimits_2_4G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM1_TxPerRatePowerLimits_2_4G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM1_DegradedLowToNormalThr_2_4G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM1_NormalToDegradedHighThr_2_4G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM1_TxPerChannelPowerLimits_2_4G_11b", l, val, + &gp->tx_per_chan_pwr_limits_11b); + + COMPARE_N_ADD("FEM1_TxPerChannelPowerLimits_2_4G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM1_TxPDVsRateOffsets_2_4G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM1_TxIbiasTable_2_4G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM1_RxFemInsertionLoss_2_4G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem1_band2_prms_128x(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl128x_ini_fem_params_2 *gp = + &(p->ini128x.dyn_radio_params_2[1].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM1_TxBiPReferencePDvoltage_2_4G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM1_TxBiPReferencePower_2_4G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM1_TxBiPOffsetdB_2_4G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM1_TxPerRatePowerLimits_2_4G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM1_TxPerRatePowerLimits_2_4G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM1_TxPerRatePowerLimits_2_4G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM1_DegradedLowToNormalThr_2_4G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM1_NormalToDegradedHighThr_2_4G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM1_TxPerChannelPowerLimits_2_4G_11b", l, val, + &gp->tx_per_chan_pwr_limits_11b); + + COMPARE_N_ADD("FEM1_TxPerChannelPowerLimits_2_4G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM1_TxPDVsRateOffsets_2_4G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM1_TxPDVsChannelOffsets_2_4G", l, val, + &gp->tx_pd_vs_chan_offsets); + + COMPARE_N_ADD("FEM1_TxPDVsTemperature_2_4G", l, val, + &gp->tx_pd_vs_temperature); + + COMPARE_N_ADD("FEM1_TxIbiasTable_2_4G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM1_RxFemInsertionLoss_2_4G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem2_band2_prms(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl1271_ini_fem_params_2 *gp = + &(p->ini1271.dyn_radio_params_2[2].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM2_TXBiPReferencePDvoltage_2_4G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM2_TxBiPReferencePower_2_4G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM2_TxBiPOffsetdB_2_4G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM2_TxPerRatePowerLimits_2_4G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM2_TxPerRatePowerLimits_2_4G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM2_TxPerRatePowerLimits_2_4G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM2_DegradedLowToNormalThr_2_4G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM2_NormalToDegradedHighThr_2_4G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM2_TxPerChannelPowerLimits_2_4G_11b", l, val, + &gp->tx_per_chan_pwr_limits_11b); + + COMPARE_N_ADD("FEM2_TxPerChannelPowerLimits_2_4G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM2_TxPDVsRateOffsets_2_4G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM2_TxIbiasTable_2_4G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM2_RxFemInsertionLoss_2_4G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem2_band2_prms_128x(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl128x_ini_fem_params_2 *gp = + &(p->ini128x.dyn_radio_params_2[2].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM2_TxBiPReferencePDvoltage_2_4G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM2_TxBiPReferencePower_2_4G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM2_TxBiPOffsetdB_2_4G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM2_TxPerRatePowerLimits_2_4G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM2_TxPerRatePowerLimits_2_4G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM2_TxPerRatePowerLimits_2_4G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM2_DegradedLowToNormalThr_2_4G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM2_NormalToDegradedHighThr_2_4G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM2_TxPerChannelPowerLimits_2_4G_11b", l, val, + &gp->tx_per_chan_pwr_limits_11b); + + COMPARE_N_ADD("FEM2_TxPerChannelPowerLimits_2_4G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM2_TxPDVsRateOffsets_2_4G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM2_TxPDVsChannelOffsets_2_4G", l, val, + &gp->tx_pd_vs_chan_offsets); + + COMPARE_N_ADD("FEM2_TxPDVsTemperature_2_4G", l, val, + &gp->tx_pd_vs_temperature); + + COMPARE_N_ADD("FEM2_TxIbiasTable_2_4G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM2_RxFemInsertionLoss_2_4G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem3_band2_prms(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl1271_ini_fem_params_2 *gp = + &(p->ini1271.dyn_radio_params_2[3].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM3_TXBiPReferencePDvoltage_2_4G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM3_TxBiPReferencePower_2_4G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM3_TxBiPOffsetdB_2_4G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM3_TxPerRatePowerLimits_2_4G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM3_TxPerRatePowerLimits_2_4G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM3_TxPerRatePowerLimits_2_4G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM3_DegradedLowToNormalThr_2_4G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM3_NormalToDegradedHighThr_2_4G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM3_TxPerChannelPowerLimits_2_4G_11b", l, val, + &gp->tx_per_chan_pwr_limits_11b); + + COMPARE_N_ADD("FEM3_TxPerChannelPowerLimits_2_4G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM3_TxPDVsRateOffsets_2_4G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM3_TxIbiasTable_2_4G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM3_RxFemInsertionLoss_2_4G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem3_band2_prms_128x(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl128x_ini_fem_params_2 *gp = + &(p->ini128x.dyn_radio_params_2[3].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM3_TxBiPReferencePDvoltage_2_4G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM3_TxBiPReferencePower_2_4G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM3_TxBiPOffsetdB_2_4G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM3_TxPerRatePowerLimits_2_4G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM3_TxPerRatePowerLimits_2_4G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM3_TxPerRatePowerLimits_2_4G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM3_DegradedLowToNormalThr_2_4G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM3_NormalToDegradedHighThr_2_4G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM3_TxPerChannelPowerLimits_2_4G_11b", l, val, + &gp->tx_per_chan_pwr_limits_11b); + + COMPARE_N_ADD("FEM3_TxPerChannelPowerLimits_2_4G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM3_TxPDVsRateOffsets_2_4G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM3_TxPDVsChannelOffsets_2_4G", l, val, + &gp->tx_pd_vs_chan_offsets); + + COMPARE_N_ADD("FEM3_TxPDVsTemperature_2_4G", l, val, + &gp->tx_pd_vs_temperature); + + COMPARE_N_ADD("FEM3_TxIbiasTable_2_4G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM3_RxFemInsertionLoss_2_4G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem0_band5_prms(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl1271_ini_fem_params_5 *gp = + &(p->ini1271.dyn_radio_params_5[0].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM0_TXBiPReferencePDvoltage_5G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM0_TxBiPReferencePower_5G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM0_TxBiPOffsetdB_5G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM0_TxPerRatePowerLimits_5G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM0_TxPerRatePowerLimits_5G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM0_TxPerRatePowerLimits_5G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM0_DegradedLowToNormalThr_5G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM0_NormalToDegradedHighThr_5G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM0_TxPerChannelPowerLimits_5G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM0_TxPDVsRateOffsets_5G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM0_TxIbiasTable_5G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM0_RxFemInsertionLoss_5G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem0_band5_prms_128x(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl128x_ini_fem_params_5 *gp = + &(p->ini128x.dyn_radio_params_5[0].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM0_TxBiPReferencePDvoltage_5G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM0_TxBiPReferencePower_5G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM0_TxBiPOffsetdB_5G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM0_TxPerRatePowerLimits_5G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM0_TxPerRatePowerLimits_5G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM0_TxPerRatePowerLimits_5G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM0_DegradedLowToNormalThr_5G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM0_NormalToDegradedHighThr_5G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM0_TxPerChannelPowerLimits_5G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM0_TxPDVsRateOffsets_5G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM0_TxPDVsChannelOffsets_5G", l, val, + &gp->tx_pd_vs_chan_offsets); + + COMPARE_N_ADD("FEM0_TxPDVsTemperature_5G", l, val, + &gp->tx_pd_vs_temperature); + + COMPARE_N_ADD("FEM0_TxIbiasTable_5G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM0_RxFemInsertionLoss_5G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem1_band5_prms(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl1271_ini_fem_params_5 *gp = + &(p->ini1271.dyn_radio_params_5[1].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM1_TXBiPReferencePDvoltage_5G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM1_TxBiPReferencePower_5G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM1_TxBiPOffsetdB_5G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM1_TxPerRatePowerLimits_5G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM1_TxPerRatePowerLimits_5G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM1_TxPerRatePowerLimits_5G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM1_DegradedLowToNormalThr_5G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM1_NormalToDegradedHighThr_5G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM1_TxPerChannelPowerLimits_5G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM1_TxPDVsRateOffsets_5G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM1_TxIbiasTable_5G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM1_RxFemInsertionLoss_5G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem1_band5_prms_128x(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl128x_ini_fem_params_5 *gp = + &(p->ini128x.dyn_radio_params_5[1].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM1_TxBiPReferencePDvoltage_5G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM1_TxBiPReferencePower_5G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM1_TxBiPOffsetdB_5G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM1_TxPerRatePowerLimits_5G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM1_TxPerRatePowerLimits_5G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM1_TxPerRatePowerLimits_5G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM1_DegradedLowToNormalThr_5G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM1_NormalToDegradedHighThr_5G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM1_TxPerChannelPowerLimits_5G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM1_TxPDVsRateOffsets_5G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM1_TxPDVsChannelOffsets_5G", l, val, + &gp->tx_pd_vs_chan_offsets); + + COMPARE_N_ADD("FEM1_TxPDVsTemperature_5G", l, val, + &gp->tx_pd_vs_temperature); + + COMPARE_N_ADD("FEM1_TxIbiasTable_5G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM1_RxFemInsertionLoss_5G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem2_band5_prms(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl1271_ini_fem_params_5 *gp = + &(p->ini1271.dyn_radio_params_5[2].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM2_TXBiPReferencePDvoltage_5G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM2_TxBiPReferencePower_5G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM2_TxBiPOffsetdB_5G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM2_TxPerRatePowerLimits_5G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM2_TxPerRatePowerLimits_5G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM2_TxPerRatePowerLimits_5G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM2_DegradedLowToNormalThr_5G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM2_NormalToDegradedHighThr_5G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM2_TxPerChannelPowerLimits_5G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM2_TxPDVsRateOffsets_5G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM2_TxIbiasTable_5G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM2_RxFemInsertionLoss_5G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem2_band5_prms_128x(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl128x_ini_fem_params_5 *gp = + &(p->ini128x.dyn_radio_params_5[2].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM2_TxBiPReferencePDvoltage_5G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM2_TxBiPReferencePower_5G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM2_TxBiPOffsetdB_5G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM2_TxPerRatePowerLimits_5G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM2_TxPerRatePowerLimits_5G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM2_TxPerRatePowerLimits_5G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM2_DegradedLowToNormalThr_5G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM2_NormalToDegradedHighThr_5G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM2_TxPerChannelPowerLimits_5G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM2_TxPDVsRateOffsets_5G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM2_TxPDVsChannelOffsets_5G", l, val, + &gp->tx_pd_vs_chan_offsets); + + COMPARE_N_ADD("FEM2_TxPDVsTemperature_5G", l, val, + &gp->tx_pd_vs_temperature); + + COMPARE_N_ADD("FEM2_TxIbiasTable_5G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM2_RxFemInsertionLoss_5G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem3_band5_prms(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl1271_ini_fem_params_5 *gp = + &(p->ini1271.dyn_radio_params_5[3].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM3_TXBiPReferencePDvoltage_5G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM3_TxBiPReferencePower_5G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM3_TxBiPOffsetdB_5G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM3_TxPerRatePowerLimits_5G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM3_TxPerRatePowerLimits_5G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM3_TxPerRatePowerLimits_5G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM3_DegradedLowToNormalThr_5G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM3_NormalToDegradedHighThr_5G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM3_TxPerChannelPowerLimits_5G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM3_TxPDVsRateOffsets_5G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM3_TxIbiasTable_5G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM3_RxFemInsertionLoss_5G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem3_band5_prms_128x(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl128x_ini_fem_params_5 *gp = + &(p->ini128x.dyn_radio_params_5[3].params); + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD2("FEM3_TxBiPReferencePDvoltage_5G", l, val, + &gp->tx_bip_ref_pd_voltage); + + COMPARE_N_ADD("FEM3_TxBiPReferencePower_5G", l, val, + &gp->tx_bip_ref_power); + + COMPARE_N_ADD("FEM3_TxBiPOffsetdB_5G", l, val, + &gp->tx_bip_ref_offset); + + COMPARE_N_ADD("FEM3_TxPerRatePowerLimits_5G_Normal", l, val, + &gp->tx_per_rate_pwr_limits_normal); + + COMPARE_N_ADD("FEM3_TxPerRatePowerLimits_5G_Degraded", l, val, + &gp->tx_per_rate_pwr_limits_degraded); + + COMPARE_N_ADD("FEM3_TxPerRatePowerLimits_5G_Extreme", l, val, + &gp->tx_per_rate_pwr_limits_extreme); + + COMPARE_N_ADD("FEM3_DegradedLowToNormalThr_5G", l, val, + &gp->degraded_low_to_normal_thr); + + COMPARE_N_ADD("FEM3_NormalToDegradedHighThr_5G", l, val, + &gp->normal_to_degraded_high_thr); + + COMPARE_N_ADD("FEM3_TxPerChannelPowerLimits_5G_OFDM", l, val, + &gp->tx_per_chan_pwr_limits_ofdm); + + COMPARE_N_ADD("FEM3_TxPDVsRateOffsets_5G", l, val, + &gp->tx_pd_vs_rate_offsets); + + COMPARE_N_ADD("FEM3_TxPDVsChannelOffsets_5G", l, val, + &gp->tx_pd_vs_chan_offsets); + + COMPARE_N_ADD("FEM3_TxPDVsTemperature_5G", l, val, + &gp->tx_pd_vs_temperature); + + COMPARE_N_ADD("FEM3_TxIbiasTable_5G", l, val, + &gp->tx_ibias); + + COMPARE_N_ADD("FEM3_RxFemInsertionLoss_5G", l, val, + &gp->rx_fem_insertion_loss); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int parse_fem_prms_128x(char *l, struct wl12xx_ini *p) +{ + char *name, *val; + struct wl128x_ini *gp = &p->ini128x; + + if (split_line(l, &name, &val)) + return 1; + + COMPARE_N_ADD("FemVendorAndOptions", l, val, + &gp->fem_vendor_and_options); + + fprintf(stderr, "Unable to parse: (%s)\n", l); + + return 1; +} + +static int find_section(const char *l, enum wl1271_ini_section *st, int *cntr, + struct wl12xx_common *cmn) +{ + enum wl12xx_arch arch = cmn->arch; + if (strncmp("TXBiPFEMAutoDetect", l, 18) == 0) { + *st = GENERAL_PRMS; + if (arch == WL128X_ARCH) + *cntr = 17; + else + *cntr = 12; + + return 0; + } + + if (strncmp("RxTraceInsertionLoss_2_4G", l, 25) == 0) { + *st = BAND2_PRMS; + if (arch == WL128X_ARCH) + *cntr = 2; + else + *cntr = 3; + + return 0; + } + + if (strncmp("FemVendorAndOptions", l, 19) == 0) { + *st = FEM_PRMS; + *cntr = 1; + return 0; + } + + if (strncmp("RxTraceInsertionLoss_5G", l, 23) == 0) { + *st = BAND5_PRMS; + if (arch == WL128X_ARCH) + *cntr = 2; + else + *cntr = 3; + + return 0; + } + + if (strncmp("FEM0_TXBiPReferencePDvoltage_2_4G", l, 33) == 0 || + strncmp("FEM0_TxBiPReferencePDvoltage_2_4G", l, 33) == 0) { + *st = FEM0_BAND2_PRMS; + cmn->fem0_bands++; + if (arch == WL128X_ARCH) + *cntr = 15; + else + *cntr = 13; + + return 0; + } + + if (strncmp("FEM1_TXBiPReferencePDvoltage_2_4G", l, 33) == 0 || + strncmp("FEM1_TxBiPReferencePDvoltage_2_4G", l, 33) == 0) { + *st = FEM1_BAND2_PRMS; + cmn->fem1_bands++; + if (arch == WL128X_ARCH) + *cntr = 15; + else + *cntr = 13; + + return 0; + } + + if (strncmp("FEM2_TXBiPReferencePDvoltage_2_4G", l, 33) == 0 || + strncmp("FEM2_TxBiPReferencePDvoltage_2_4G", l, 33) == 0) { + *st = FEM2_BAND2_PRMS; + cmn->fem2_bands++; + if (arch == WL128X_ARCH) + *cntr = 15; + else + *cntr = 13; + + return 0; + } + + if (strncmp("FEM3_TXBiPReferencePDvoltage_2_4G", l, 33) == 0 || + strncmp("FEM3_TxBiPReferencePDvoltage_2_4G", l, 33) == 0) { + *st = FEM3_BAND2_PRMS; + cmn->fem3_bands++; + if (arch == WL128X_ARCH) + *cntr = 15; + else + *cntr = 13; + + return 0; + } + + if (strncmp("FEM0_TXBiPReferencePDvoltage_5G", l, 31) == 0 || + strncmp("FEM0_TxBiPReferencePDvoltage_5G", l, 31) == 0) { + *st = FEM0_BAND5_PRMS; + cmn->fem0_bands++; + if (arch == WL128X_ARCH) + *cntr = 14; + else + *cntr = 12; + + return 0; + } + + if (strncmp("FEM1_TXBiPReferencePDvoltage_5G", l, 31) == 0 || + strncmp("FEM1_TxBiPReferencePDvoltage_5G", l, 31) == 0) { + *st = FEM1_BAND5_PRMS; + cmn->fem1_bands++; + if (arch == WL128X_ARCH) + *cntr = 14; + else + *cntr = 12; + + return 0; + } + + if (strncmp("FEM2_TXBiPReferencePDvoltage_5G", l, 31) == 0 || + strncmp("FEM2_TxBiPReferencePDvoltage_5G", l, 31) == 0) { + *st = FEM2_BAND5_PRMS; + cmn->fem2_bands++; + if (arch == WL128X_ARCH) + *cntr = 14; + else + *cntr = 12; + + return 0; + } + + if (strncmp("FEM3_TXBiPReferencePDvoltage_5G", l, 31) == 0 || + strncmp("FEM3_TxBiPReferencePDvoltage_5G", l, 31) == 0) { + *st = FEM3_BAND5_PRMS; + cmn->fem3_bands++; + if (arch == WL128X_ARCH) + *cntr = 14; + else + *cntr = 12; + + return 0; + } + + return 1; +} + +static const char* ini_section_str(enum wl1271_ini_section section) +{ + const char *section_str; + + switch(section) { + + case GENERAL_PRMS: + section_str = "GENERAL_PARAMS"; + break; + + case FEM_PRMS: + section_str = "FEM_PARAMS"; + break; + + case BAND2_PRMS: + section_str = "BAND2_PARAMS"; + break; + + case BAND5_PRMS: + section_str = "BAND5_PARAMS"; + break; + + case FEM0_BAND2_PRMS: + section_str = "FEM0_BAND2_PARAMS"; + break; + + case FEM1_BAND2_PRMS: + section_str = "FEM1_BAND2_PARAMS"; + break; + + case FEM2_BAND2_PRMS: + section_str = "FEM2_BAND2_PARAMS"; + break; + + case FEM3_BAND2_PRMS: + section_str = "FEM3_BAND2_PARAMS"; + break; + + case FEM0_BAND5_PRMS: + section_str = "FEM0_BAND5_PARAMS"; + break; + + case FEM1_BAND5_PRMS: + section_str = "FEM1_BAND5_PARAMS"; + break; + + case FEM2_BAND5_PRMS: + section_str = "FEM2_BAND5_PARAMS"; + break; + + case FEM3_BAND5_PRMS: + section_str = "FEM3_BAND5_PARAMS"; + break; + + case UKNOWN_SECTION: + default: + section_str = "UNKNOWN_SECTION"; + break; + } + + return section_str; +} + +static int ini_parse_line(char *l, struct wl12xx_common *cmn) +{ + static enum wl1271_ini_section status; + static int cntr; + + if (cntr) { + /* + * Recovery mode - + * Check if didn't finish current section and we are already in + * another one. This can happen in case of optional params in section. + */ + enum wl1271_ini_section curr_section = status; + if (!find_section(l, &status, &cntr, cmn)) { + printf("Some params missing in ini section %s moving to section %s\n", + ini_section_str(curr_section), + ini_section_str(status)); + } + } + + if (!cntr && find_section(l, &status, &cntr, cmn)) { + fprintf(stderr, "Uknown ini section %s\n", l); + return 1; + } + + switch (status) { + case GENERAL_PRMS: /* general parameters */ + cntr--; + return cmn->parse_ops->prs_general_prms(l, cmn, &cmn->ini); + case FEM_PRMS: /* FEM parameters */ + if (cmn->arch == WL1271_ARCH) { + fprintf(stderr, "The parameter not from 127x architecture\n"); + return 1; + } + cntr--; + return parse_fem_prms_128x(l, &cmn->ini); + case BAND2_PRMS: /* band 2.4GHz parameters */ + cntr--; + return cmn->parse_ops->prs_band2_prms(l, &cmn->ini); + case BAND5_PRMS: /* band 5GHz parameters */ + cntr--; + return cmn->parse_ops->prs_band5_prms(l, &cmn->ini); + case FEM0_BAND2_PRMS: /* FEM0 band 2.4GHz parameters */ + cntr--; + return cmn->parse_ops->prs_fem0_band2_prms(l, &cmn->ini); + case FEM1_BAND2_PRMS: /* FEM1 band 2.4GHz parameters */ + cntr--; + return cmn->parse_ops->prs_fem1_band2_prms(l, &cmn->ini); + case FEM2_BAND2_PRMS: /* FEM2 band 2.4GHz parameters */ + cntr--; + return cmn->parse_ops->prs_fem2_band2_prms(l, &cmn->ini); + case FEM3_BAND2_PRMS: /* FEM3 band 2.4GHz parameters */ + cntr--; + return cmn->parse_ops->prs_fem3_band2_prms(l, &cmn->ini); + case FEM0_BAND5_PRMS: /* FEM0 band 5GHz parameters */ + cntr--; + return cmn->parse_ops->prs_fem0_band5_prms(l, &cmn->ini); + case FEM1_BAND5_PRMS: /* FEM1 band 5GHz parameters */ + cntr--; + return cmn->parse_ops->prs_fem1_band5_prms(l, &cmn->ini); + case FEM2_BAND5_PRMS: /* FEM2 band 5GHz parameters */ + cntr--; + return cmn->parse_ops->prs_fem2_band5_prms(l, &cmn->ini); + case FEM3_BAND5_PRMS: /* FEM3 band 5GHz parameters */ + cntr--; + return cmn->parse_ops->prs_fem3_band5_prms(l, &cmn->ini); + case UKNOWN_SECTION: + /* added because of compilation warning. handeled in find_section() */ + break; + } + + return 1; +} + +#if 0 +static void ini_dump(struct wl1271_ini *ini) +{ + int i; + + printf("\n"); + printf("General params:\n"); + printf("ref clock: %02X\n", + ini->general_params.ref_clock); + printf("settling time: %02X\n", + ini->general_params.settling_time); + printf("clk valid on wakeup: %02X\n", + ini->general_params.clk_valid_on_wakeup); + printf("dc2dc mode: %02X\n", + ini->general_params.dc2dc_mode); + printf("dual band mode: %02X\n", + ini->general_params.dual_mode_select); + printf("tx bip fem auto detect: %02X\n", + ini->general_params.tx_bip_fem_auto_detect); + printf("tx bip fem manufacturer: %02X\n", + ini->general_params.tx_bip_fem_manufacturer); + printf("general settings: %02X\n", + ini->general_params.general_settings); + printf("sr state: %02X\n", + ini->general_params.sr_state); + + printf("srf1:"); + for (i = 0; i < WL1271_INI_MAX_SMART_REFLEX_PARAM; i++) + printf(" %02X", ini->general_params.srf1[i]); + printf("\n"); + + printf("srf2:"); + for (i = 0; i < WL1271_INI_MAX_SMART_REFLEX_PARAM; i++) + printf(" %02X", ini->general_params.srf2[i]); + printf("\n"); + + printf("srf3:"); + for (i = 0; i < WL1271_INI_MAX_SMART_REFLEX_PARAM; i++) + printf(" %02X", ini->general_params.srf3[i]); + printf("\n"); + + printf("Static 2.4 band params:\n"); + + printf("rx trace insertion loss: %02X\n", + ini->stat_radio_params_2.rx_trace_insertion_loss); + + printf("rx rssi n process compensation:"); + for (i = 0; i < WL1271_INI_RSSI_PROCESS_COMPENS_SIZE; i++) + printf(" %02X", + ini->stat_radio_params_2.rx_rssi_process_compens[i]); + printf("\n"); + + printf("tx trace: %02X\n", + ini->stat_radio_params_2.tx_trace_loss); + + printf("Dynamic 2.4 band params for FEM\n"); + + printf("Static 5 band params:\n"); + + printf("rx trace insertion loss:"); + for (i = 0; i < WL1271_INI_SUB_BAND_COUNT_5; i++) + printf(" %02X", + ini->stat_radio_params_5.rx_rssi_process_compens[i]); + printf("\n"); + + printf("rx rssi n process compensation:"); + for (i = 0; i < WL1271_INI_RSSI_PROCESS_COMPENS_SIZE; i++) + printf(" %02X", + ini->stat_radio_params_5.rx_rssi_process_compens[i]); + printf("\n"); + + printf("tx trace:"); + for (i = 0; i < WL1271_INI_SUB_BAND_COUNT_5; i++) + printf(" %02X", + ini->stat_radio_params_5.tx_trace_loss[i]); + printf("\n"); + + printf("Dynamic 5 band params for FEM\n"); + +} +#endif + + +static int is_dual_mode(struct wl12xx_ini *p) +{ + struct wl1271_ini_general_params *gp = &(p->ini1271.general_params); + return gp->dual_mode_select; +} + +static int is_dual_mode_128x(struct wl12xx_ini *p) +{ + struct wl128x_ini_general_params *gp = &(p->ini128x.general_params); + return gp->dual_mode_select; +} + + +static struct wl12xx_parse_ops wl1271_parse_ops = { + .prs_general_prms = parse_general_prms, + .prs_band2_prms = parse_band2_prms, + .prs_band5_prms = parse_band5_prms, + .prs_fem0_band2_prms = parse_fem0_band2_prms, + .prs_fem1_band2_prms = parse_fem1_band2_prms, + .prs_fem2_band2_prms = parse_fem2_band2_prms, + .prs_fem3_band2_prms = parse_fem3_band2_prms, + .prs_fem0_band5_prms = parse_fem0_band5_prms, + .prs_fem1_band5_prms = parse_fem1_band5_prms, + .prs_fem2_band5_prms = parse_fem2_band5_prms, + .prs_fem3_band5_prms = parse_fem3_band5_prms, + .is_dual_mode = is_dual_mode, +}; + +static struct wl12xx_parse_ops wl128x_parse_ops = { + .prs_general_prms = parse_general_prms_128x, + .prs_band2_prms = parse_band2_prms_128x, + .prs_band5_prms = parse_band5_prms_128x, + .prs_fem0_band2_prms = parse_fem0_band2_prms_128x, + .prs_fem1_band2_prms = parse_fem1_band2_prms_128x, + .prs_fem2_band2_prms = parse_fem2_band2_prms_128x, + .prs_fem3_band2_prms = parse_fem3_band2_prms_128x, + .prs_fem0_band5_prms = parse_fem0_band5_prms_128x, + .prs_fem1_band5_prms = parse_fem1_band5_prms_128x, + .prs_fem2_band5_prms = parse_fem2_band5_prms_128x, + .prs_fem3_band5_prms = parse_fem3_band5_prms_128x, + .is_dual_mode = is_dual_mode_128x, +}; + +int ini_get_dual_mode(struct wl12xx_common *cmn) +{ + return cmn->parse_ops->is_dual_mode(&cmn->ini); +} + +int nvs_get_arch(int file_size, struct wl12xx_common *cmn) +{ + enum wl12xx_arch arch = UNKNOWN_ARCH; + + switch (file_size) { + case WL127X_NVS_FILE_SZ: + arch = WL1271_ARCH; + cmn->parse_ops = &wl1271_parse_ops; + break; + case WL128X_NVS_FILE_SZ: + arch = WL128X_ARCH; + cmn->parse_ops = &wl128x_parse_ops; + break; + } + + if (cmn->arch != UNKNOWN_ARCH && cmn->arch != arch) { + cmn->parse_ops = NULL; + return 1; + } + + cmn->arch = arch; + + return 0; +} + +static int ini_get_arch(FILE *f, struct wl12xx_common *cmn) +{ + char buf[1024], *pos; + int line = 0; + enum wl12xx_arch arch = UNKNOWN_ARCH; + + while (ini_get_line(buf, sizeof(buf), f, &line, &pos)) { + if (strncmp("TCXO_Clk", pos, 8) == 0) { + arch = WL128X_ARCH; + break; + } + } + + if (arch == UNKNOWN_ARCH) + arch = WL1271_ARCH; + + if (cmn->arch != UNKNOWN_ARCH && cmn->arch != arch) + return 1; + + cmn->arch = arch; + + if (cmn->arch == WL1271_ARCH) + cmn->parse_ops = &wl1271_parse_ops; + else + cmn->parse_ops = &wl128x_parse_ops; + + fseek(f, 0L, SEEK_SET); + + return 0; +} + +int read_ini(const char *filename, struct wl12xx_common *cmn) +{ + FILE *f; + char buf[1024], *pos; + int ret = 0, line = 0; + + cmn->auto_fem = 0; + cmn->fem0_bands = 0; + cmn->fem1_bands = 0; + cmn->fem2_bands = 0; + cmn->fem3_bands = 0; + + f = fopen(filename, "r"); + if (f == NULL) { + fprintf(stderr, "Unable to open file %s (%s)\n", + filename, strerror(errno)); + return 1; + } + + /* check if it 127x or 128x */ + if (ini_get_arch(f, cmn)) { + fprintf(stderr, "Unable to define wireless architecture\n"); + ret = 1; + goto out; + } + + /* start parsing */ + while (ini_get_line(buf, sizeof(buf), f, &line, &pos)) { + ret = ini_parse_line(pos, cmn); + if (ret) break; + } + +out: + fclose(f); +#if 0 + ini_dump(ini); +#endif + return ret; +} |