Да вообщем то проще самому написать ибо пока разберешься как адаптировать программу к своей системе- времени пройдет много.
Для начала - выделите режимы в которых будет работать система и для каждого режима выпишите контроль и управление + действия при авариях.
Создайте матрицу переходов.
После этого программа пишется очень короткое время