Simplified code for update front and back sides
Improved testing code and simplified other code

Removed unused optimization option for robot bodies.
Run queue now takes triple of robot, context, and queue.