Added Global Reset

Master:
Programs starts with reset packet, then transmits first Init Packet
found location send bug, partly fixed, location transmission is still
not programmed
other small bugs

Slave:
New reset function
if statement to reset in got message, if got reset packet, re- init all
data
other small bugs