单轴丝杠平台实现搬运功能

机器谱

1. 功能说明
       本文示例将实现R279样机单轴丝杠平台搬运的功能。

       该机构是由一个丝杠模组和一个 舵机关节模组【https://www.robotway.com/h-col-121.html】 组合而成，关节模组上安装了一个电磁铁。

       注意限位开关【①触碰传感器、②近红外传感器】的安装位置：

2. 丝杠传动机构原理
       丝杠传动机构是一个将转动转化为平动的机构，丝杠与移动的滑块之间通过螺纹传动；电机的旋转运动通过丝杆传递给滑块，由于滑块被支架限制不能进行旋转运动，所以滑块最终将旋转的运动转换为水平方向的移动。

运动特性：通过上面的分析可以看出，这是一种螺旋机构，具有以下特点
       (1) 回转运动变换为直线运动，运动准确性高，且有很大的降速比；复式螺旋可以获得较大的位移，差动螺旋可以获得微小的位移；
       (2) 结构简单，制造方便；
       (3) 工作平稳，无噪声，可以传递很大的轴向力；
       (4) 传动效率低，有自锁作用，相对运动表面磨损较快；
       (5) 实现往复运动要靠主动件改变转动方向。
       丝杠机构的的稳定性很好，可以承受较大的力，所以如果要设计一些直线运输重物的机构时可以考虑利用丝杠来实现。

3. 电子硬件
       本实验中采用了以下硬件：

主控板	Basra主控板（兼容Arduino Uno）‍
扩展板	Bigfish2.1扩展板‍
传感器	触碰传感器
	近红外传感器
电池	7.4V锂电池

电路连接说明：
       ① 步进电机：黑D5，绿D6，红D9，蓝D10
       ② 近红外传感器：A2
       ③ 触碰传感器：A0
       ④ 电磁铁：D3

4. 功能实现
编程环境：Arduino 1.8.19
下面提供一个单轴丝杠平台搬运的参考例程（_1.ino），将参考例程下载到主控板中，具体实验效果可参考官网演示视频。

1. /*------------------------------------------------------------------------------------
   
2. 
   
3.   版权说明：Copyright 2023 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved.
   
4. 
   
5.            Distributed under MIT license.See file LICENSE for detail or copy at
   
6. 
   
7.            https://opensource.org/licenses/MIT
   
8. 
   
9.            by 机器谱 2023-04-19 https://www.robotway.com/
   
10. 
    
11.   ------------------------------*/
    
12. 
    
13. #include <Stepper.h>
    
14. 
    
15. 
    
16. const int stepsPerRevolution = 200;               //步进电机每圈转动的步数
    
17. 
    
18. Stepper myStepper_X(stepsPerRevolution,5,6,9,10); //定义步进电机的引脚
    
19. 
    
20. #define SENSOR_RESET A0     //宏定义步进电机复位传感器引脚 A0
    
21. 
    
22. #define SENSOR_UN A2        //定义物块检测传感器引脚 A2
    
23. 
    
24. #define STEP_X 2500         //定义抓取物块后行进的步数
    
25. 
    
26. #define electromagnet 3     //定义电磁铁引脚
    
27. 
    
28. 
    
29. #include <Servo.h>         
    
30. 
    
31. Servo myServo;            
    
32. 
    
33. #define SERVO_UP 30         //定义舵机上下转动的角度
    
34. 
    
35. #define SERVO_DOWN 1
    
36. 
    
37. #define TIME 2000
    
38. 
    
39. 
    
40. int delta = 10;
    
41. 
    
42. 
    
43. void setup() {
    
44. 
    
45.   Serial.begin(9600);        //开启串口通信，波特率为9600
    
46. 
    
47.   pinMode(SENSOR_RESET,INPUT);
    
48. 
    
49.   pinMode(SENSOR_UN,INPUT);
    
50. 
    
51.   pinMode(electromagnet,OUTPUT);
    
52. 
    
53.   myServo.attach(4);
    
54. 
    
55.   myServo.write(SERVO_UP);
    
56. 
    
57.   myStepper_X.setSpeed(60);
    
58. 
    
59.   resetStepper();
    
60. 
    
61.   delay(1000);
    
62. 
    
63. }
    
64. 
    
65. 
    
66. void loop() {
    
67. 
    
68.   while(digitalRead(SENSOR_UN)){
    
69. 
    
70.     delay(10);                 //物块检测传感器循环检测，未触发为 1，进入while循环等待，触发为0，跳出循环，执行后面物块抓取函数
    
71. 
    
72.   }
    
73. 
    
74.   get();
    
75. 
    
76.   put();
    
77. 
    
78. }
    
79. 
    
80. 
    
81. //步进电机复位函数
    
82. 
    
83. void resetStepper()
    
84. 
    
85. {
    
86. 
    
87.   while(digitalRead(SENSOR_RESET))
    
88. 
    
89.   {
    
90. 
    
91.     myStepper_X.step(-10);
    
92. 
    
93.   }
    
94. 
    
95.   myStepper_X.step(15);
    
96. 
    
97. }
    
98. 
    
99. 
    
100. //物块抓取函数
     
101. 
     
102. void get()
     
103. 
     
104. {
     
105. 
     
106.   Serial.println("begin");
     
107. 
     
108.   myStepper_X.step(1500);
     
109. 
     
110.   ServoMove(SERVO_UP,SERVO_DOWN,TIME);
     
111. 
     
112.   digitalWrite(electromagnet,HIGH);       //电磁铁引脚置高电平 吸取物块
     
113. 
     
114.   ServoMove(SERVO_DOWN,SERVO_UP,TIME);
     
115. 
     
116. }
     
117. 
     
118. 
     
119. //物块释放函数
     
120. 
     
121. void put()
     
122. 
     
123. {
     
124. 
     
125.     myStepper_X.step(STEP_X);
     
126. 
     
127.     ServoMove(SERVO_UP,SERVO_DOWN,TIME);
     
128. 
     
129.     digitalWrite(electromagnet,LOW);      //电磁铁引脚置低电平 释放物块
     
130. 
     
131.     ServoMove(SERVO_DOWN,SERVO_UP,TIME);
     
132. 
     
133.     resetStepper();
     
134. 
     
135. }
     
136. 
     
137. 
     
138. //舵机转动函数，传三个参数，start为起始角度，finish为目标角度，t为时间
     
139. 
     
140. void ServoMove(int _start, int _finish, long t)
     
141. 
     
142. {
     
143. 
     
144.     static int direct;
     
145. 
     
146.     static int diff;
     
147. 
     
148.     static long deltaTime;
     
149. 
     
150.     if(_start <= _finish)
     
151. 
     
152.       direct = 1;
     
153. 
     
154.     else
     
155. 
     
156.       direct = -1;
     
157. 
     
158.     diff = abs(_finish - _start);
     
159. 
     
160.     deltaTime = (long) (t / diff);
     
161. 
     
162.    
     
163. 
     
164.     for(int i = 0; i < diff; i++)
     
165. 
     
166.      {
     
167. 
     
168.         myServo.write(_start + i * direct);
     
169. 
     
170.         delay(deltaTime);
     
171. 
     
172.      }
     
173. 
     
174.      delay(deltaTime);
     
175. 
     
176. }

复制代码

5. 资料下载
资料内容：
​①搬运-例程源代码
​②搬运-样机3D文件
​资料下载地址：https://www.robotway.com/h-col-210.html

想了解更多机器人开源项目资料请关注 机器谱网站 https://www.robotway.com