Function work now, trying to do funny thing.
1. tank can go forward, backward, turn right and left.
2. Detect the object distance
3. stepper motor can turn to absolute angle.
4. detect distance on every angle of stepper motor and find the shortest distance of every angle.