Звучит как отличный план, если сделаешь модульную конструкцию и код максимально простым. Таймер сторожевой службы на микроконтроллере может быстро перезагрузить систему, если что-то пойдет не так, а несколько базовых датчиков позволят роботу понять, если сустав вышел из строя. Не усложняй программу — просто несколько условий и цикл, проверяющий состояние. Сделай конечности так, чтобы они сами возвращались на место, и у тебя получится машина, которая сама себя чинит без лишней мороки. Держи стоимость и сложность на минимуме — и она справится.