я предпологал такой алгоритм: при необходимости поворота изменяем угол опоры которая будет следующей при перекатывании,изменяем ещё до перекатывания.
после того как перекатились(ну и терминология,детский сад какой-то),выравниваем весь механизм относительно опоры.
как-то так.
А теперь надо сделать зеленые штуки круглыми и так, чтобы они утоплены были в куб
это уже детали,я вообще не предпологал продолжать проект.