2015-02-13 21:41:38 -05:00
|
|
|
#include "CollectTote.h"
|
|
|
|
|
#include "../../DentRobot.h"
|
|
|
|
|
#include "../Autonomous/AutoDrive.h"
|
|
|
|
|
#include "RollIn.h"
|
|
|
|
|
#include "CloseCollector.h"
|
|
|
|
|
CollectTote::CollectTote(){
|
2015-02-13 22:30:15 -05:00
|
|
|
AddParallel(new CloseCollector());
|
2015-02-14 14:31:38 -05:00
|
|
|
AddParallel(new AutoDrive(0.5, -1.0));
|
|
|
|
|
AddSequential(new RollIn());
|
|
|
|
|
AddParallel(new CloseCollector());
|
|
|
|
|
AddParallel(new AutoDrive(0.5, 1.0));
|
|
|
|
|
AddSequential(new RollIn());
|
|
|
|
|
AddParallel(new CloseCollector());
|
|
|
|
|
AddParallel(new AutoDrive(0.5, -1.0));
|
2015-02-14 13:36:50 -05:00
|
|
|
AddSequential(new RollIn());
|
2015-02-13 21:41:38 -05:00
|
|
|
}
|
|
|
|
|
// vim: ts=2:sw=2:et
|
