Merge pull request #6 from chiwunau/use_pid_control

Use pid control
add bar to change max distance
add subcriber and publisher of selected box
remove some codes that is not used
changed some time interval