서보모터를 MG-995 모터로 바꿔서 360도 회전이 가능하게 되었고 전류 측정 센서도 추가해 보려 하는데
 
#include 
 
Servo mc1;
Servo mc2;
 
int tri=3;
int echo=2;
 
void setup()
{
 
pinMode(tri,OUTPUT);
 
pinMode(echo,INPUT);
 
Serial.begin(115200);
mc1.attach(10);
mc2.attach(11);
}
 
void loop()
{
{
float duration, distance;
 
digitalWrite(tri,HIGH);
 
delay(10);
 
digitalWrite(tri,LOW);
 
 
duration = pulseIn(echo,HIGH);
 
distance = ((float)(340 * duration) / 10000) / 2;
 
Serial.print("Duration : ");
 
Serial.println(duration);
 
Serial.print("Distance : ");
 
Serial.print(distance);
 
Serial.println("cm\n");
 
delay(500);
 
 
if(distance<=5)
 
{
 
for(int i = 0; i < 180; ++i)
 
{
 
mc1.write(i);
mc2.write(i);
 
delay(10);
 
}
 
 
mc1.write(0);
mc2.write(0);
 
delay(10);
 
}
 
int light = analogRead(A0);
Serial.print("밝기 : ");
Serial.println(light);
delay(100);
 
if(light <= 400)
{
  
  for(int i = 0; i < 180; ++i)
{
mc1.write(i);
mc2.write(i);
delay(10);
}
 
mc1.write(0);
mc2.write(0);
delay(100);
 }
}
}
 
이 코딩을 어떻게 바꿔버려야 초음파,조도센서,전류센서, 모터를 유기적으로 작동시킬 수 있을까요..?
섞이니까 이게 되면 저게 안되고 그러네요..