Сделал, работает. Но ПИД регуляторам крышу сносит. После возобновления питания по выходам пид регуляторов (из стандартной библиотеки util) -1.#QNAN. И теперь мне бы сбросить их (регуляторы) после восстановления питания. Вот с микроконтролелрами всё просто, там есть специальные регистры и биты, указывающие, в чём причина сброса. А как здесь определить, что питание отвалилось, потом вновь появилась. Хотел выделить на это не ретайн переменную, записать в неё один раз, а потом читать и если содержимое не совпадёт, сбросить регуляторы, но не факт, что содержимое этой переменной обнулится после пропадания питания. Хотелось бы что-нибудь более надёжное.