Создать функцию на ST

[kondor3000]

Согласен на счет развития проекта все нормально идет темпы хорошие так держать. Но думаю на первых парах в ST не стоит вкладывается во все функции на это нужно уйма времени.
А вот выходов в функции можно добавить.

Нельзя в функции выходов добавить (читайте описание функции и отличие от ФБ), можно в ФБ или в макросе добавить.
В этом весь и смысл, сразу пошли по неверному пути.