Add and Fix (EncapPacket Thingy)

Added send encapsulated packet and
fixed some errors.