Fixed convertion from angle to indexes on segment detector
Added simple search robot
Modified HT-1 robot to search and destroy, simple version