Added GPS lock waiting, waits for lock after power on