標(biāo)題: 樹莓派RP2350實(shí)現(xiàn)步進(jìn)電機(jī)精確控制 [打印本頁]
作者: lijinlei    時(shí)間: 2025-5-3 14:51
標(biāo)題: 樹莓派RP2350實(shí)現(xiàn)步進(jìn)電機(jī)精確控制
本文介紹了 樹莓派 RP2350 開發(fā)板實(shí)現(xiàn)步進(jìn)電機(jī)驅(qū)動(dòng)的項(xiàng)目設(shè)計(jì)，主要包括旋轉(zhuǎn)角度的精確控制、串口發(fā)送實(shí)現(xiàn)自定義角度旋轉(zhuǎn)、OLED 顯示旋轉(zhuǎn)狀態(tài)三部分。

擴(kuò)展板PCB工程詳見：Beetle-RP2350擴(kuò)展板 - 立創(chuàng)開源硬件平臺(tái)oshwhubcom/lijinlei0907/beetle-rp2350-expansion-board

項(xiàng)目介紹

包括步進(jìn)電機(jī)原理、該項(xiàng)目使用的 28BYJ-48 步進(jìn)電機(jī)，及其驅(qū)動(dòng)器——ULN2003 驅(qū)動(dòng)模塊介紹。

步進(jìn)電機(jī)原理

步進(jìn)電機(jī)（Stepper Motor）是一種將電脈沖信號(hào)轉(zhuǎn)換為精確角度位移的執(zhí)行器件，屬于開環(huán)控制電機(jī)。

核心特點(diǎn)：每接收一個(gè)脈沖，轉(zhuǎn)子就轉(zhuǎn)動(dòng)一個(gè)固定的角度（稱為“步距角”），無需反饋傳感器即可實(shí)現(xiàn)位置控制。



28BYJ-48 步進(jìn)電機(jī)

28BYJ-48 是一款常見的低成本、小扭矩 5 線單極步進(jìn)電機(jī)，可使用 ULN2003 控制器和單片機(jī)實(shí)現(xiàn)旋轉(zhuǎn)控制，廣泛用于打印機(jī)、掃描儀、攝像機(jī)云臺(tái)、空調(diào)、家電、玩具、消費(fèi)電子等領(lǐng)域。




參數(shù)
值/描述
電機(jī)類型
單極 4 相永磁式步進(jìn)電機(jī)（5線制）
步距角
5.625°（64 步/圈），配合減速齒輪后 0.0879°（實(shí)際輸出軸 4096 步/圈）
減速比
1:64（內(nèi)部齒輪組減速）
額定電壓
5V 或 12V DC
相電流
約 100mA（每相）
保持扭矩
約 0.1 N·m（輸出軸，受減速齒輪影響）
繞組電阻
約 50Ω/相


實(shí)際輸出軸步距角為 5.625°/64 ≈ 0.0879°，轉(zhuǎn)一圈理論上需要 64×64=4096 步，實(shí)際可能存在誤差。

詳見： 28BYJ-48 數(shù)據(jù)手冊(cè).pdf (193.2 KB, 下載次數(shù): 0)

ULN2003 驅(qū)動(dòng)器

ULN2003 是一款常用的達(dá)林頓晶體管陣列芯片，專為驅(qū)動(dòng)高電流負(fù)載（如繼電器、步進(jìn)電機(jī)、LED陣列等）設(shè)計(jì)。其作用是將 MCU 輸出的弱電流信號(hào)轉(zhuǎn)換為大電流輸出，是控制 28BYJ-48 步進(jìn)電機(jī)的核心驅(qū)動(dòng)芯片。



原理圖



使用時(shí)需要將 28BYJ-48 步進(jìn)電機(jī)的5線快接插頭與 ULN2003 模塊對(duì)應(yīng)接口連接，并將模塊的 4 個(gè)控制引腳（信號(hào)輸入端，絲印 IN1、IN2、IN3、IN4）與單片機(jī)對(duì)應(yīng)引腳相連，實(shí)現(xiàn)控制信號(hào)輸入。

詳見： uln2003a.pdf (2.04 MB, 下載次數(shù): 0)

項(xiàng)目方案

具體執(zhí)行方案和工程測(cè)試流程如下

旋轉(zhuǎn)指定角度

本節(jié)介紹并實(shí)現(xiàn)了指定角度的步進(jìn)電機(jī)旋轉(zhuǎn)控制。

硬件連接






代碼


  1. '''
  2. Name: Stepper Motor driven by ULN2003
  3. Version: v1.0
  4. Date: 2025.05
  5. Author: ljl
  6. Other: Rotate stepper motor (28byj-48) for custom angle.
  7. Hardware connect:
  8. 0 ---- IN1 (ULN2003)
  9. 1 ---- IN2 (ULN2003)
  10. 18 ---- IN3 (ULN2003)
  11. 19 ---- IN4 (ULN2003)
  12. '''
  13. ​
  14. from machine import Pin
  15. import utime
  16. ​
  17. # 電機(jī)控制引腳
  18. coils = [
  19.     Pin(0, Pin.OUT),  # A相 (IN1)
  20.     Pin(1, Pin.OUT),  # B相 (IN2)
  21.     Pin(18, Pin.OUT),  # C相 (IN3)
  22.     Pin(19, Pin.OUT)   # D相 (IN4)
  23. ]
  24. ​
  25. # 四相八拍步進(jìn)電機(jī)的順序值
  26. STEP_SEQ = [
  27.     [1, 0, 0, 1],  # AB'
  28.     [1, 0, 0, 0],  # A
  29.     [1, 1, 0, 0],  # AB
  30.     [0, 1, 0, 0],  # B
  31.     [0, 1, 1, 0],  # BC
  32.     [0, 0, 1, 0],  # C
  33.     [0, 0, 1, 1],  # CD
  34.     [0, 0, 0, 1]   # D
  35. ]
  36. ​
  37. '''
  38. 驅(qū)動(dòng)電機(jī)旋轉(zhuǎn)指定步數(shù)
  39. :param steps: 正數(shù)=順時(shí)針，負(fù)數(shù)=逆時(shí)針
  40. :param delay_ms: 步間延時(shí)(ms)，控制轉(zhuǎn)速
  41. '''
  42. def step_motor(steps, delay_ms=1):
  43.     direction = 1 if steps >=0 else -1
  44.     for _ in range(abs(steps)):
  45.         for phase in range(8)[::direction]:  # 方向控制
  46.             for coil, state in zip(coils, STEP_SEQ[phase]):
  47.                 coil.value(state)
  48.             utime.sleep_ms(delay_ms)
  49. ​
  50. # 旋轉(zhuǎn)角度控制
  51. def rotate_angle(angle):
  52.     steps_per_rev = 509
  53.     steps = int(angle * (steps_per_rev / 360))
  54.     step_motor(steps)
  55. ​
  56. # 釋放電機(jī)扭矩
  57. def release():
  58.     for coil in coils:
  59.         coil.value(0)
  60. ​
  61. while True:
  62.     #rotate_angle(1) # 以單步方式持續(xù)轉(zhuǎn)動(dòng)
  63.     rotate_angle(180) # 逆時(shí)針
  64.     release()
  65.     utime.sleep_ms(2000)
  66.     rotate_angle(-90) # 順時(shí)針
  67.     release()
  68.     utime.sleep_ms(2000)
復(fù)制代碼




效果



由供電處的電壓-電流計(jì)量工具可知，步進(jìn)電機(jī)旋轉(zhuǎn)工作時(shí)的功率約為 1W



串口自定義角度

在實(shí)現(xiàn)步進(jìn)電機(jī)旋轉(zhuǎn)驅(qū)動(dòng)的基礎(chǔ)上，進(jìn)一步實(shí)現(xiàn)串口發(fā)送自定義角度并旋轉(zhuǎn)的功能設(shè)計(jì)方案。

硬件連接




​

代碼


  1. '''
  2. Name: Stepper Motor rotate custom angle from serial
  3. Version: v1.0
  4. Date: 2025.05
  5. Author: ljl
  6. Other: Rotate stepper motor (28byj-48) for custom angle from UART.
  7. Hardware connect:
  8. 0 ---- IN1 (ULN2003)
  9. 1 ---- IN2 (ULN2003)
  10. 4 ---- IN3 (ULN2003)
  11. 5 ---- IN4 (ULN2003)
  12. 8 ---- RXD (CH340)
  13. 9 ---- TXD (CH340)
  14. '''
  15. ​
  16. from machine import Pin, UART
  17. import utime
  18. import ujson
  19. ​
  20. # 電機(jī)控制引腳
  21. coils = [
  22.     Pin(0, Pin.OUT),  # A相 (IN1)
  23.     Pin(1, Pin.OUT),  # B相 (IN2)
  24.     Pin(4, Pin.OUT),  # C相 (IN3)
  25.     Pin(5, Pin.OUT)   # D相 (IN4)
  26. ]
  27. ​
  28. # 四相八拍步進(jìn)電機(jī)的相序
  29. STEP_SEQ = [
  30.     [1, 0, 0, 1],  # AB'
  31.     [1, 0, 0, 0],  # A
  32.     [1, 1, 0, 0],  # AB
  33.     [0, 1, 0, 0],  # B
  34.     [0, 1, 1, 0],  # BC
  35.     [0, 0, 1, 0],  # C
  36.     [0, 0, 1, 1],  # CD
  37.     [0, 0, 0, 1]   # D
  38. ]
  39. ​
  40. # 驅(qū)動(dòng)電機(jī)旋轉(zhuǎn)指定步數(shù)；delay_ms 步間延時(shí)(ms)，控制轉(zhuǎn)速
  41. def step_motor(steps, delay_ms=1):
  42.     direction = 1 if steps >=0 else -1
  43.     for _ in range(abs(steps)):
  44.         for phase in range(8)[::direction]:  # 方向控制
  45.             for coil, state in zip(coils, STEP_SEQ[phase]):
  46.                 coil.value(state)
  47.             utime.sleep_ms(delay_ms)
  48. ​
  49. # 角度控制
  50. def rotate_angle(angle):
  51.     steps_per_rev = 509
  52.     steps = int(angle * (steps_per_rev / 360))
  53.     step_motor(steps)
  54. ​
  55. # 釋放電機(jī)扭矩
  56. def release():
  57.     for coil in coils:
  58.         coil.value(0)
  59. ​
  60. # 串口控制旋轉(zhuǎn)角度
  61. def uart_control():
  62.     uart = machine.UART(1, baudrate=9600, tx=Pin(8), rx=Pin(9))
  63.     while True:
  64.         if uart.any():
  65.             cmd = uart.read()
  66.             try:
  67.                 data = ujson.loads(cmd)
  68.                 rotate_angle(int(data['angle']))
  69.                 release()
  70.             except:
  71.                 uart.write('Invalid command\r\n')
  72.                 release()
  73.         else:
  74.             release()
  75.         utime.sleep_ms(100)
  76. ​
  77. # main loop
  78. while True:
  79.     uart_control()
復(fù)制代碼


這里為了節(jié)能并提高效率，僅在串口發(fā)送正確指令時(shí)旋轉(zhuǎn)，其他情況均釋放步進(jìn)電機(jī)扭矩，此時(shí)電流約為 0 .


效果


由于調(diào)用了 ujson 庫(kù)，因此串口發(fā)送指令需符合 json 格式，如 {"angle":40} .

若串口發(fā)送 json 消息的格式錯(cuò)誤，則反饋指令無效的提示。

OLED 顯示旋轉(zhuǎn)狀態(tài)

在前面實(shí)現(xiàn)步進(jìn)電機(jī)旋轉(zhuǎn)驅(qū)動(dòng)、串口自定義角度控制的基礎(chǔ)上，進(jìn)一步實(shí)現(xiàn)串口發(fā)送角度、旋轉(zhuǎn)、OLED 狀態(tài)顯示的功能設(shè)計(jì)方案。

硬件連接




流程圖




代碼


  1. '''
  2. Name: Stepper Motor rotate custom angle from serial and OLED display
  3. Version: v1.0
  4. Date: 2025.05
  5. Author: ljl
  6. Other: Rotate stepper motor (28byj-48) for custom angle from UART, and OLED display the motor state in moving or steady.
  7. Hardware connect:
  8. 0 ---- IN1 (ULN2003)
  9. 1 ---- IN2 (ULN2003)
  10. 18 ---- IN3 (ULN2003)
  11. 19 ---- IN4 (ULN2003)
  12. 8 ---- RXD (CH340)
  13. 9 ---- TXD (CH340)
  14. 4 ---- SDA (OLED_SSD1306)
  15. 5 ---- SCL (OLED_SSD1306)
  16. Serial send style: {"angle": 40}
  17. '''
  18. ​
  19. from machine import Pin, UART, SoftI2C
  20. import ssd1306 # OLED
  21. import ujson # read uart string
  22. import utime
  23. ​
  24. # ==== Initialized IIC OLED ====
  25. i2c = SoftI2C(scl=Pin(5), sda=Pin(4))
  26. oled_width = 128
  27. oled_height = 64
  28. oled = ssd1306.SSD1306_I2C(oled_width, oled_height, i2c)
  29. ​
  30. # display the motor state
  31. def display_motor(angle,state):
  32.     oled.fill(0)  # 清屏
  33.     oled.text("Rotate Angle: ", 0, 0)
  34.     oled.text("{:.1f} deg".format(angle), 20, 15)
  35.     oled.text("State: ", 0, 35)
  36.     if state == 1:
  37.         oled.text("Rotating ...", 20, 50)
  38.     elif state == 0:
  39.         oled.text("Reset", 20, 50)
  40.     else:
  41.         oled.text("Error", 20, 50)
  42.     oled.show()
  43. ​
  44. # 電機(jī)控制引腳
  45. coils = [
  46.     Pin(0, Pin.OUT),  # A相 (IN1)
  47.     Pin(1, Pin.OUT),  # B相 (IN2)
  48.     Pin(18, Pin.OUT),  # C相 (IN3)
  49.     Pin(19, Pin.OUT)   # D相 (IN4)
  50. ]
  51. ​
  52. # 四相八拍步進(jìn)電機(jī)的相序
  53. STEP_SEQ = [
  54.     [1, 0, 0, 1],  # AB'
  55.     [1, 0, 0, 0],  # A
  56.     [1, 1, 0, 0],  # AB
  57.     [0, 1, 0, 0],  # B
  58.     [0, 1, 1, 0],  # BC
  59.     [0, 0, 1, 0],  # C
  60.     [0, 0, 1, 1],  # CD
  61.     [0, 0, 0, 1]   # D
  62. ]
  63. ​
  64. # 驅(qū)動(dòng)電機(jī)旋轉(zhuǎn)指定步數(shù)；delay_ms 步間延時(shí)(ms)，控制轉(zhuǎn)速
  65. def step_motor(steps, delay_ms=1):
  66.     direction = 1 if steps >=0 else -1
  67.     for _ in range(abs(steps)):
  68.         for phase in range(8)[::direction]:  # 方向控制
  69.             for coil, state in zip(coils, STEP_SEQ[phase]):
  70.                 coil.value(state)
  71.             utime.sleep_ms(delay_ms)
  72. ​
  73. # 角度控制
  74. def rotate_angle(angle):
  75.     steps_per_rev = 509  # 64步/拍 × 8拍 × 8相位
  76.     steps = int(angle * (steps_per_rev / 360))
  77.     step_motor(steps)
  78. ​
  79. # 釋放電機(jī)扭矩
  80. def release():
  81.     for coil in coils:
  82.         coil.value(0)
  83. ​
  84. # 串口控制旋轉(zhuǎn)角度
  85. def uart_control():
  86.     uart = machine.UART(1, baudrate=9600, tx=Pin(8), rx=Pin(9))
  87.     while True:
  88.         if uart.any():
  89.             cmd = uart.read()
  90.             try:
  91.                 data = ujson.loads(cmd)
  92.                 ra = float(data['angle']) # rotate angle
  93.                 display_motor(ra,1)
  94.                 rotate_angle(ra)
  95.                 release()
  96.                 display_motor(ra,0)
  97.             except:
  98.                 uart.write('Invalid command\r\n')
  99.                 release()
  100.         else:
  101.             release()
  102.             #display_motor(0,0)
  103.         utime.sleep_ms(100)
  104. ​
  105. # main loop
  106. display_motor(0,0) # initialize OLED display
  107. while True:
  108.     uart_control()
復(fù)制代碼


效果







總結(jié)

本文介紹了樹莓派 RP2350 開發(fā)板實(shí)現(xiàn)步進(jìn)電機(jī)驅(qū)動(dòng)的項(xiàng)目設(shè)計(jì)，包括旋轉(zhuǎn)角度的精確控制、串口發(fā)送實(shí)現(xiàn)自定義角度旋轉(zhuǎn)、OLED 顯示旋轉(zhuǎn)狀態(tài)等，為 RP2350 的開發(fā)、設(shè)計(jì)和應(yīng)用提供了參考。







歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1