kopia lustrzana https://github.com/pimoroni/pimoroni-pico
56 wiersze
1.3 KiB
Python
56 wiersze
1.3 KiB
Python
import time
|
|
import math
|
|
from inventor import Inventor2040W, MOTOR_A
|
|
|
|
"""
|
|
Demonstrates how to control a motor on Inventor 2040 W.
|
|
"""
|
|
|
|
# Create a new Inventor2040W
|
|
board = Inventor2040W()
|
|
|
|
# Access the motor from Inventor and enable it
|
|
m = board.motors[MOTOR_A]
|
|
m.enable()
|
|
time.sleep(2)
|
|
|
|
# Drive at full positive
|
|
m.full_positive()
|
|
time.sleep(2)
|
|
|
|
# Stop moving
|
|
m.stop()
|
|
time.sleep(2)
|
|
|
|
# Drive at full negative
|
|
m.full_negative()
|
|
time.sleep(2)
|
|
|
|
# Coast to a gradual stop
|
|
m.coast()
|
|
time.sleep(2)
|
|
|
|
|
|
SWEEPS = 2 # How many speed sweeps of the motor to perform
|
|
STEPS = 10 # The number of discrete sweep steps
|
|
STEPS_INTERVAL = 0.5 # The time in seconds between each step of the sequence
|
|
SPEED_EXTENT = 1.0 # How far from zero to drive the motor when sweeping
|
|
|
|
# Do a sine speed sweep
|
|
for j in range(SWEEPS):
|
|
for i in range(360):
|
|
m.speed(math.sin(math.radians(i)) * SPEED_EXTENT)
|
|
time.sleep(0.02)
|
|
|
|
# Do a stepped speed sweep
|
|
for j in range(SWEEPS):
|
|
for i in range(0, STEPS):
|
|
m.to_percent(i, 0, STEPS, 0.0 - SPEED_EXTENT, SPEED_EXTENT)
|
|
time.sleep(STEPS_INTERVAL)
|
|
for i in range(0, STEPS):
|
|
m.to_percent(i, STEPS, 0, 0.0 - SPEED_EXTENT, SPEED_EXTENT)
|
|
time.sleep(STEPS_INTERVAL)
|
|
|
|
# Disable the motor
|
|
m.disable()
|