Motor Rotation Based on Turn Input Value
This program demonstrates a simple motor control application using Python. The main objective of the script is to rotate a motor by a specific number of turns, which is determined by the user input. The motor's position is tracked, and it continues to rotate until the desired number of turns is achieved.
Key Components:
USB Connection and Serial Communication:
The program first detects the available USB serial port by checking the connected devices. This is done using the
serial
module and thecomports()
method. The program checks for the USB Serial Port on Windows,/dev/ttyUSB
on Linux, and/dev/tty.usbserial
or/dev/tty.usbmodem
on macOS, depending on the operating system.
Motor Control with SMD Red:
The motor control is handled by the
smd.red
library, which provides an interface to communicate with the motor using the Red controller. TheMaster
andRed
objects are used to establish communication with the motor and send commands to it.
Motor Rotation Logic:
The motor rotation is based on the encoder counts per revolution (CPR). The variable
steps_per_turn
represents the CPR, which is typically a value like6533
for many motors.The function
rotate_motor(turns)
takes the number of turns as input, calculates the corresponding target position (in encoder steps), and then continuously rotates the motor until the target position is reached.The
m.set_velocity()
function is used to set the speed of the motor, and the motor stops once the desired position is achieved.
User Input:
The program prompts the user to input the number of turns they wish the motor to rotate. The
rotate_motor()
function then handles the rotation based on this input.
Threading and Time Control:
The program uses a simple
while
loop withtime.sleep(0.01)
to periodically check the motor’s position. This ensures the motor rotates in a controlled manner, and the loop continues until the target position is reached.
Example Usage:
When the program is executed, it will ask the user to input the number of turns:
Enter the number of turns: 5
After the user inputs the value (e.g., 5), the motor will rotate the equivalent number of turns. The program will print a message once the motor has completed the rotation:
It has been rotated as many times as the number of turns entered. Number of turns: 5
Code
import serial
from smd.red import Master, Red
from threading import Thread
import time
from serial.tools.list_ports import comports
from platform import system
def USB_Port():
ports = list(comports())
usb_names = {
"Windows": ["USB Serial Port"],
"Linux": ["/dev/ttyUSB"],
"Darwin": [
"/dev/tty.usbserial",
"/dev/tty.usbmodem",
"/dev/tty.SLAB_USBtoUART",
"/dev/tty.wchusbserial",
"/dev/cu.usbserial",
"/dev/cu.usbmodem",
"/dev/cu.SLAB_USBtoUART",
"/dev/cu.wchusbserial",
]
}
os_name = system()
if ports:
for port, desc, hwid in sorted(ports):
if any(name in port or name in desc for name in usb_names.get(os_name, [])):
return port
print("Current ports:")
for port, desc, hwid in ports:
print(f"Port: {port}, Description: {desc}, Hardware ID: {hwid}")
else:
print("No port found")
return None
port = USB_Port()
m = Master(port)
motor = m.attach(Red(0))
def rotate_motor(turns):
steps_per_turn = 6533 # Set according to the encoder CPR value
target_position = turns * steps_per_turn # Calculate the target position
current_position = m.get_position(0) # get motor position
# Rotate the motor until the target position is reached.
m.set_velocity(id=0, sp=10000) # Set to maximum speed
while abs(m.get_position(0) - current_position) < target_position:
time.sleep(0.01) # Wait for a short time
m.set_velocity(id=0, sp=0) # Stop the motor
turns = input("Enter the number of turns: ")
rotate_motor(int(turns))
print("It has been rotated as many times as the number of turns entered. Number of turns:"+turns)
Last updated