fix a bug(using sensor id)

add branch to choose sensor id(3001 or 3005) in move function