검색해서 공부중이지만 제가 원하는 방식으로 구동하는 예는 찾아도 잘 없고 비슷한걸 찾아서 응용하려해도 잘 되지 않네요.

제가 원하는 제어는 

1-전원이 들어오면 서보 모터가 0도에 자리잡습니다.

2-푸쉬 버튼을 5초간 누르지 않으면 180도까지 한번 갔다가 0도로 돌아오는 것을 반복합니다.

3-하지만 2번을 수행중에  푸쉬 버튼을 누르면 즉시 90도까지 움직였다가 0도로 돌아옵니다.

이걸 구현하고 싶은데 제가 너무 초보라서 감도 못잡겠습니다.

여기저기서 보고 조금씩 수정해봐도 명령문을 조금 바꾸면 작동을 안하거나 2번 문장만 계속 반복합니다.

코팅 예제나 비슷한 예제가 있으면 알려주실 수 있나요?