Fixed bug in setting message data byte 2