Merge branches 'version3' and 'qwerty1' into version3
updata serial packet 5 for laser init, update nav filter for laser init and update nav filter output