Да и сделать для ПИДов отдельную подпрограмму, с временем цикла, скажем 100-200 мс.
А можно поподробней про отдельную подпрограмму? Это надо использовать задачи? Чем этот вариант лучше?