Massive changes: Packet restructure, implemented 0x06 (not working) and Fixed some stuff

Massive changes: Packet restructure, implemented 0x06 (not working) and
Fixed some stuff