Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit e1fb97b9 authored by Christophe Ricard's avatar Christophe Ricard Committed by Samuel Ortiz
Browse files

NFC: st21nfca: Fix st21nfca_hci_remove_len_crc tail room handling 



There is no byte stuffing when data are stored in skb.
TAILROOM is 2 byte crc + 1 byte eof.

st21nfca_hci_remove_len_crc was doing an incorrect operation on
the TAILROOM data.
If shdlc timer T2 is triggered, it will request to send the same data.
Before every hci data was lost after st21nfca_hci_remove_len_crc.

Signed-off-by: default avatarChristophe Ricard <christophe-h.ricard@st.com>
Signed-off-by: default avatarSamuel Ortiz <sameo@linux.intel.com>
parent 3096e25a

drivers/nfc/st21nfca/i2c.c

+9 −12
Original line number Original line Diff line number Diff line
@@ -48,11 +48,11 @@ 
#define ST21NFCA_BYTE_STUFFING_MASK	0x20

#define ST21NFCA_BYTE_STUFFING_MASK	0x20

#define ST21NFCA_ESCAPE_BYTE_STUFFING	0x7d

#define ST21NFCA_ESCAPE_BYTE_STUFFING	0x7d





/* SOF + 00 fill size */

/* SOF + 00 */

#define ST21NFCA_FRAME_HEADROOM			2

#define ST21NFCA_FRAME_HEADROOM			2





/* 4 bytes crc (worst case byte stuffing) + EOF */

/* 2 bytes crc + EOF */

#define ST21NFCA_FRAME_TAILROOM 5

#define ST21NFCA_FRAME_TAILROOM 3





#define ST21NFCA_HCI_I2C_DRIVER_NAME "st21nfca_hci_i2c"

#define ST21NFCA_HCI_I2C_DRIVER_NAME "st21nfca_hci_i2c"
@@ -166,9 +166,8 @@ static void st21nfca_hci_i2c_disable(void *phy_id) 
	phy->powered = 0;

	phy->powered = 0;

}

}





static int st21nfca_hci_add_len_crc(struct sk_buff *skb)

static void st21nfca_hci_add_len_crc(struct sk_buff *skb)

{

{

	int ret = 2;

	u16 crc;

	u16 crc;

	u8 tmp;

	u8 tmp;
@@ -182,14 +181,12 @@ static int st21nfca_hci_add_len_crc(struct sk_buff *skb) 




	tmp = (crc >> 8) & 0x00ff;

	tmp = (crc >> 8) & 0x00ff;

	*skb_put(skb, 1) = tmp;

	*skb_put(skb, 1) = tmp;



	return ret;

}

}





static void st21nfca_hci_remove_len_crc(struct sk_buff *skb, int crc_len)

static void st21nfca_hci_remove_len_crc(struct sk_buff *skb)

{

{

	skb_pull(skb, ST21NFCA_FRAME_HEADROOM);

	skb_pull(skb, ST21NFCA_FRAME_HEADROOM);

	skb_trim(skb, crc_len);

	skb_trim(skb, skb->len - ST21NFCA_FRAME_TAILROOM);

}

}





/*

/*
@@ -199,7 +196,7 @@ static void st21nfca_hci_remove_len_crc(struct sk_buff *skb, int crc_len) 
 */

 */

static int st21nfca_hci_i2c_write(void *phy_id, struct sk_buff *skb)

static int st21nfca_hci_i2c_write(void *phy_id, struct sk_buff *skb)

{

{

	int r = -1, i, j, len;

	int r = -1, i, j;

	struct st21nfca_i2c_phy *phy = phy_id;

	struct st21nfca_i2c_phy *phy = phy_id;

	struct i2c_client *client = phy->i2c_dev;

	struct i2c_client *client = phy->i2c_dev;

	u8 tmp[ST21NFCA_HCI_LLC_MAX_SIZE * 2];

	u8 tmp[ST21NFCA_HCI_LLC_MAX_SIZE * 2];
@@ -215,7 +212,7 @@ static int st21nfca_hci_i2c_write(void *phy_id, struct sk_buff *skb) 
	 * Note st21nfca_hci_add_len_crc is doing a byte stuffing

	 * Note st21nfca_hci_add_len_crc is doing a byte stuffing

	 * on its own value

	 * on its own value

	 */

	 */

	len = st21nfca_hci_add_len_crc(skb);

	st21nfca_hci_add_len_crc(skb);





	/* add ST21NFCA_SOF_EOF on tail */

	/* add ST21NFCA_SOF_EOF on tail */

	*skb_put(skb, 1) = ST21NFCA_SOF_EOF;

	*skb_put(skb, 1) = ST21NFCA_SOF_EOF;
@@ -259,7 +256,7 @@ static int st21nfca_hci_i2c_write(void *phy_id, struct sk_buff *skb) 
			r = 0;

			r = 0;

	}

	}





	st21nfca_hci_remove_len_crc(skb, len);

	st21nfca_hci_remove_len_crc(skb);





	return r;

	return r;

}

}