Boa noite pessoal, sou iniciante e estou precisando de uma ajuda no código.

Quero acessar uma porta (servo) distante onde tem 3 luzes junto com o teclado matricial. Pelo teclado quando aperto o botão A, o motor é acionado e as luzes verde e amarela são acesas, sendo que apenas a amarela não apaga. O problema é que ao acionar o motor em seguida ele volta na posição original. Ele deveria ser acionado e esperar apertar o botão C, onde a luz é apagada e motor é acionado para fechar a porta.

1) Acessamos o password "1234" e o servo motor é acionado (180 graus), e as luzes verde e amarela acendem e logo em seguida o motor gira de volta para a posição original.
2) Em poucos segundos a verde apaga e a amarela fica acesa (indicando que uma porta por exemplo ficou aberta)
3) Se colocamos a senha errada a luz vermelha é acesa e apaga logo em seguida

Nos botões do teclado matricial o A serve para verificar a senha
B para limpar a senha
C apagar amarela e fechar a porta

Dúvida no código:
É exatamente a parte em vermelho que tenho dúvida e se vc poderia numa rápida verificação no código o porquê de estar acontecendo.
1) O motor NÃO deveria retornar para a posição original...(a porta deve estar ainda aberta)
2) A porta não fecha na linha do código onde específico o que acontece quando aperto o C (Case "C"....)

Agradeço muito se puderem dar uma olhada!