implemented push_cube() arguments into half of the algorithms
implemented servo actions into all algorithms