Corrected final packet size

Corrected final packet size issue using the sub-header field packet size