add RobotQueue.rb
add test2.rb & solve all bugs