본문 바로가기
Electronics/Raspberry Pi

[Raspberry Pi] 가변저항 VR1 으로 서보모터 각도(0~180도) 컨트롤하기

by 겨울 빛 2020. 12. 30.

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)

 

댓글