터치센서를 한번 누르면 서보모터가 90도 움직이고 다시 누르면 서보모터가 0도로 되돌아오게하려면

아래코드를  어떻게 수정해야하나요?

그리고 하드웨어 연결을 어떻게 해야하는지 이미지로 알려주실수 있나요?

터치센서는 ttp223b 쓰려고합니다.

#include // 서보 라이브러리

const int S = 2;
const int ledPin = 13;
int sensorstate = 0;
Servo motor1; // 서보 모터 오브젝트
int position = 0;

void setup(){

pinMode(ledPin, OUTPUT);
 pinMode(S, INPUT);
 motor1.attach(9); // 서보 모터를 9번에 연결
}

void loop(){

 for(int position = 0; position < 180;position += 2) // 0도에서 180까지 2도씩 증가
{
motor1.write(position); // 모터를 position만큼회전
delay(20); // 모터가 돌 때까지 기다림.
 }

for(int position = 180; position >= 0;position -= 2)//180도에서 0도까지 2도씩 감소
{
motor1.write(position); // 모터를 position만큼회전
delay(20); // 모터가 돌 때까지 기다림.
 }

sensorstate = digitalRead(S);

 if (sensorstate == HIGH) {
 digitalWrite(ledPin, HIGH);
 } else {
 digitalWrite(ledPin, LOW);
 }
}