Commit f8e26cde authored by Marko Ristola's avatar Marko Ristola Committed by Mauro Carvalho Chehab
Browse files

V4L/DVB (13718): [Mantis] Use gpio_set_bits to turn OFF the bits as well

parent 77557abe
Loading
Loading
Loading
Loading
+7 −9
Original line number Diff line number Diff line
@@ -172,25 +172,23 @@ int mantis_core_exit(struct mantis_pci *mantis)
	return 0;
}

// Turn the given bit on or off.
void gpio_set_bits(struct mantis_pci *mantis, u32 bitpos, u8 value)
{
	u32 reg;
	u32 currVal, newVal;

	currVal = mmread(MANTIS_GPIF_ADDR);

	if (value)
		reg = 0x0000;
		newVal = currVal | (1 << bitpos);
	else
		reg = 0xffff;

	reg = (value << bitpos);
		newVal = currVal & (~(1 << bitpos));

	mmwrite(mmread(MANTIS_GPIF_ADDR) | reg, MANTIS_GPIF_ADDR);
	mmwrite(newVal, MANTIS_GPIF_ADDR);
	mmwrite(0x00, MANTIS_GPIF_DOUT);
	udelay(100);
	mmwrite(mmread(MANTIS_GPIF_ADDR) | reg, MANTIS_GPIF_ADDR);
	mmwrite(0x00, MANTIS_GPIF_DOUT);
}


//direction = 0 , no CI passthrough ; 1 , CI passthrough
void mantis_set_direction(struct mantis_pci *mantis, int direction)
{