Electronics/Raspberry Pi
[Raspberry Pi] 가변저항 VR1 으로 서보모터 각도(0~180도) 컨트롤하기
겨울 빛
2020. 12. 30. 04:53
import RPi.GPIO as GPIO
import time
import CK_SPI_ADC as spi_adc
import CK_SPI_DEV as spi_dev
#나중에 나올 DELAY 값 미리 0.5로 정의함
DELAY = 0.5
# Map Function
def ck_map(x, in_min, in_max, out_min, out_max) :
out_val = (((x - in_min) * (out_max - out_min)) / (in_max - in_min)) + out_min
return out_val
try :
while(1) :
# Read VR1 and Set FWD
speed = spi_adc.ck_adcRd(spi_adc.ADC_CH_VR1)
speed = ck_map(speed, 0, 1023, 0, 180)
#읽어들여온 VR1의 값으로 서보모터 각도 설정하기
#위에서 정의한 DELAY 값 만큼 멈췄다가 반복
spi_dev.ck_servoMot(speed)
time.sleep(DELAY)