diff --git a/net/mhi/l3mhdp.c b/net/mhi/l3mhdp.c
index a728eea..6acf1f6 100644
--- a/net/mhi/l3mhdp.c
+++ b/net/mhi/l3mhdp.c
@@ -557,6 +557,11 @@
 	}
 	rcu_read_unlock();
 
+	if (mhdp_header_len > skb_headlen(skb))
+		kfree(mhdpHdr);
+
+	dev_kfree_skb(skb);
+
 	return err;
 
 error: