동작 코드
모터 속도 범위는 2000이고 (48 - 2047)
RC 조종기 범위는 1000이라서 (1000-2000)
원하는 모터 속도 = (RC 조종기 수신 값 - 1000) * 2 + 47
로 바꿔줬다.
while (1)
{
if(mychannel_data[4] == 2000) // arming
{
if(mychannel_data[2] > 1011) // 69
{
for(int i = 0; i < 4; i++)
myvalue[i] = (mychannel_data[2] - 1000) * 2 + 47;
}
else
{
for(int i = 0; i < 4; i++)
myvalue[i] = 69; // minimum value to spin smoothly
}
}
else // disarming
{
for(int i = 0; i < 4; i++)
myvalue[i] = 0;
}
}