1、设置舵机角度 XRservo.XiaoRGEEK_SetServo(0x01,angle) 注释:此函数为设置1号舵机角度为angle 2、舵机角度记忆,存储当前所有舵机角度值。 XRservo.XiaoRGEEK_SaveServo() 3、恢复所有舵机至已存储的角度 XRservo.XiaoRGEEK_ReSetServo() ''' time.sleep(2) XRservo.XiaoRGEEK_SetServo(0x01, 90) ##设置1舵机角度90° print 'ser1= 90° ' time.sleep(0.5) XRservo.XiaoRGEEK_SetServo(0x01, 30) ##设置1舵机角度30° print 'ser1= 30°并存储 ' time.sleep(0.1) XRservo.XiaoRGEEK_SaveServo() ##存储当前角度(30°) time.sleep(0.5) XRservo.XiaoRGEEK_SetServo(0x01, 90) ##设置1舵机角度90° print 'ser1= 90° ' time.sleep(0.5) XRservo.XiaoRGEEK_SetServo(0x01, 150) ##设置1舵机角度150° print 'ser1= 150° ' time.sleep(1.5) XRservo.XiaoRGEEK_ReSetServo() ##恢复舵机存储的角度(30°) print '恢复存储的角度30° ' ''' 整个程序功能为: 舵机转动到90° 舵机转动到30°,并存储, 依次隔0.5s,转动到90°及150° 隔1.5s后,恢复存储的角度30°
import time import binascii import RPi.GPIO as GPIO from smbus import SMBus XRservo = SMBus(1) GPIO.setmode(GPIO.BCM) GPIO.setwarnings(False) time.sleep(2) XRservo.XiaoRGEEK_SetServo(0x08, 90) print('ser1= 90') time.sleep(0.5) XRservo.XiaoRGEEK_SetServo(0x01, 30) print('ser1= 30°并存储') time.sleep(0.1) XRservo.XiaoRGEEK_SaveServo() time.sleep(0.5) XRservo.XiaoRGEEK_SetServo(0x01, 90) print('ser1= 90°') time.sleep(0.5) XRservo.XiaoRGEEK_SetServo(0x01, 150) print('ser1= 150°') time.sleep(1.5) XRservo.XiaoRGEEK_ReSetServo() print('恢复存储的角度30°') ''' 整个程序功能为: 舵机转动到90° 舵机转动到30°,并存储, 依次隔0.5s,转动到90°及150° 隔1.5s后,恢复存储的角度30°