diff options
author | Tzafrir Cohen <tzafrir.cohen@xorcom.com> | 2011-09-25 08:59:02 +0000 |
---|---|---|
committer | Tzafrir Cohen <tzafrir.cohen@xorcom.com> | 2011-09-25 08:59:02 +0000 |
commit | 824b6c8cba4c073a18d87add3a4513ccee9b4965 (patch) | |
tree | 2ccf7dd03fc481ea6a6216c61f77435f0d780e42 /drivers/dahdi/xpp/card_fxs.c | |
parent | 185f0b7682a11a706057a4d6bcc17c92953fc455 (diff) |
xpp: fxs: bugfix for 2fxs+6fxo cards
* Bug sympthoms: wrong FSK VMWI sent few seconds after
offhook. That was caused because the driver kept
polling the (physically unconnected) digital inputs.
[note: a workaround for drivers without this patch
is to zero the 'xpd_fxs.poll_digital_inputs' parameter.]
* Also, the digital_inputs/digital_output masks were
calculate using a different condition.
* Now we determine number of channels, digital inputs and
digital outputs in a single place and use this info
later to calculate the correct masks.
* We poll only if there are digital_inputs
* We added a sanity check in process_digital_inputs, so
we get a notice if it's called on an xpd without digital
inputs (e.g: hypothetic firmware bug).
Signed-off-by: Tzafrir Cohen <tzafrir.cohen@xorcom.com>
Acked-by: Tzafrir Cohen <tzafrir.cohen@xorcom.com>
git-svn-id: http://svn.asterisk.org/svn/dahdi/linux/branches/2.5@10208 a0bf4364-ded3-4de4-8d8a-66a801d63aff
Diffstat (limited to 'drivers/dahdi/xpp/card_fxs.c')
-rw-r--r-- | drivers/dahdi/xpp/card_fxs.c | 39 |
1 files changed, 31 insertions, 8 deletions
diff --git a/drivers/dahdi/xpp/card_fxs.c b/drivers/dahdi/xpp/card_fxs.c index db80e42..d296164 100644 --- a/drivers/dahdi/xpp/card_fxs.c +++ b/drivers/dahdi/xpp/card_fxs.c @@ -386,6 +386,8 @@ static xpd_t *FXS_card_new(xbus_t *xbus, int unit, int subunit, const xproto_tab int regular_channels; struct FXS_priv_data *priv; int i; + int d_inputs = 0; + int d_outputs = 0; if(!to_phone) { XBUS_NOTICE(xbus, @@ -398,16 +400,30 @@ static xpd_t *FXS_card_new(xbus_t *xbus, int unit, int subunit, const xproto_tab else regular_channels = min(8, subunit_ports); channels = regular_channels; - if(unit == 0 && subtype != 4) + /* Calculate digital inputs/outputs */ + if(unit == 0 && subtype != 4) { channels += 6; /* 2 DIGITAL OUTPUTS, 4 DIGITAL INPUTS */ + d_inputs = LINES_DIGI_INP; + d_outputs = LINES_DIGI_OUT; + } xpd = xpd_alloc(xbus, unit, subunit, subtype, subunits, sizeof(struct FXS_priv_data), proto_table, channels); if(!xpd) return NULL; - if(unit == 0) { - XBUS_DBG(GENERAL, xbus, "First XPD detected. Initialize digital outputs/inputs\n"); - PHONEDEV(xpd).digital_outputs = BITMASK(LINES_DIGI_OUT) << regular_channels; - PHONEDEV(xpd).digital_inputs = BITMASK(LINES_DIGI_INP) << (regular_channels + LINES_DIGI_OUT); - } + /* Initialize digital inputs/outputs */ + if (d_inputs) { + XBUS_DBG(GENERAL, xbus, "Initialize %d digital inputs\n", + d_inputs); + PHONEDEV(xpd).digital_inputs = + BITMASK(d_inputs) << (regular_channels + d_outputs); + } else + XBUS_DBG(GENERAL, xbus, "No digital inputs\n"); + if (d_outputs) { + XBUS_DBG(GENERAL, xbus, "Initialize %d digital outputs\n", + d_outputs); + PHONEDEV(xpd).digital_outputs = + BITMASK(d_outputs) << regular_channels; + } else + XBUS_DBG(GENERAL, xbus, "No digital outputs\n"); PHONEDEV(xpd).direction = TO_PHONE; xpd->type_name = "FXS"; if(fxs_proc_create(xbus, xpd) < 0) @@ -1142,7 +1158,7 @@ static int FXS_card_tick(xbus_t *xbus, xpd_t *xpd) priv = xpd->priv; BUG_ON(!priv); #ifdef POLL_DIGITAL_INPUTS - if(poll_digital_inputs && xpd->xbus_idx == 0) { + if (poll_digital_inputs && PHONEDEV(xpd).digital_inputs) { if((xpd->timer_count % poll_digital_inputs) == 0) poll_inputs(xpd); } @@ -1254,6 +1270,13 @@ static void process_digital_inputs(xpd_t *xpd, const reg_cmd_t *info) bool offhook = (REG_FIELD(info, data_low) & 0x1) == 0; xpp_line_t lines = BIT(info->portnum); + /* Sanity check */ + if (!PHONEDEV(xpd).digital_inputs) { + XPD_NOTICE(xpd, + "%s called without digital inputs. Ignored\n", + __func__); + return; + } /* Map SLIC number into line number */ for(i = 0; i < ARRAY_SIZE(input_channels); i++) { int channo = input_channels[i]; @@ -1366,7 +1389,7 @@ static int FXS_card_register_reply(xbus_t *xbus, xpd_t *xpd, reg_cmd_t *info) /* * Process digital inputs polling results */ - else if(xpd->xbus_idx == 0 && !indirect && regnum == REG_DIGITAL_IOCTRL) { + else if (!indirect && regnum == REG_DIGITAL_IOCTRL) { process_digital_inputs(xpd, info); } #endif |