Нужно рисовать блок схему перед созданием программы, упростит ли она работу?
Если вам это поможет - зарисуйте, нарисуйте, разложите на блоки и кирпичики. Все инструменты, облегчающие понимание, но не усложняющие задачу - хороши.
Управляющая логика Stateflow в Матлабе (Симулинк либо без него).