Experimental: Fixed init packet
Experimental: Added checksum check
Experimental: Code cleanup