[test] add sensor test code

need way to know distance...