xpp: FXS type 6: support digital outputs

Signed-off-by: Tzafrir Cohen <tzafrir.cohen@xorcom.com>
This commit is contained in:
Dima Stoliarov 2016-03-31 20:13:32 +03:00 committed by Tzafrir Cohen
parent aaa1080a7c
commit 020735e3a7

View File

@ -826,23 +826,34 @@ static void start_stop_vm_led(xbus_t *xbus, xpd_t *xpd, lineno_t pos)
static int relay_out(xpd_t *xpd, int pos, bool on)
{
int value;
int ret = 0;
int value = 0;
int which = pos;
int relay_channels[] = { 0, 4 };
BUG_ON(!xpd);
/* map logical position to output port number (0/1) */
which -= (XPD_HW(xpd).subtype == 2) ? 6 : 8;
LINE_DBG(SIGNAL, xpd, pos, "which=%d -- %s\n", which,
(on) ? "on" : "off");
which = which % ARRAY_SIZE(relay_channels);
if (XPD_HW(xpd).type == 6) {
int relay_values_type6[] = { 0x01, 0x40 };
which = which % ARRAY_SIZE(relay_values_type6);
if (on)
value |= relay_values_type6[which];
ret = EXP_REQUEST(xpd->xbus, xpd, SLIC_WRITE,
REG_TYPE6_EXP_GPIOB, value, relay_values_type6[which]);
} else {
int relay_channels_type1[] = { 0, 4 };
which = which % ARRAY_SIZE(relay_channels_type1);
value = BIT(2) | BIT(3);
value |=
((BIT(5) | BIT(6) | BIT(7)) & ~led_register_mask[OUTPUT_RELAY]);
if (on)
value |= led_register_vals[OUTPUT_RELAY];
return SLIC_DIRECT_REQUEST(xpd->xbus, xpd, relay_channels[which],
ret = SLIC_DIRECT_REQUEST(xpd->xbus, xpd, relay_channels_type1[which],
SLIC_WRITE, REG_TYPE1_DIGITAL_IOCTRL, value);
}
return ret;
}
static int send_ring(xpd_t *xpd, lineno_t chan, bool on)