Optimization for a small robot
Just a little change
Implemented TCP search algorithm
Removed unneeded clases
Completed TCP search alg optimization