久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

<dl id="iaikc"><em id="iaikc"></em></dl>

<button id="iaikc"><strong id="iaikc"></strong></button>

<button id="iaikc"></button>

標題: Arduino控制小米微電機(基于MCP2515)運動 [打印本頁]

---

作者: tjd666    時間: 2024-4-1 20:04
標題: Arduino控制小米微電機(基于MCP2515)運動
一、前言
最近接觸到一個項目需要用到小米電機，本來是想用STM32進行控制，但是必須得使用Arduino進行開發，于是嘗試了一下。小米電機是基于CAN通訊的，但恰好Arduino不帶CAN通訊協議，于是難度上了一個檔次。在查閱了相關資料后，偶然間看到B站某位大佬的視頻，得到了啟發，在此感謝這位大佬，并成功實現了目標功能，鏈接如下：www.bilibili.com/video/BV1P64y1p7hx/

二、準備
硬件：
1、MCP2515 SPI2CAN轉換器 *1
2、小米微電機 *1
3、電機轉接頭 *1
4、Arduino Nano *1
5、轉接線 *若干
6、usb to can轉換頭

知識儲備：
1、掌握Arduino開發，能讀懂程序
2、了解CAN協議
3、了解小米微電機相關參數，電機運轉方式

三、接線及庫的準備
參考一篇文章的CAN協議進行接線，鏈接如下：gitcodecom/autowp/arduino-mcp2515/overview?utm_source=csdn_github_accelerator&isLogin=1



注意，小米電機供電為24V，電流在額定電流左右即可。具體相關參數在小米電機手冊中查看。CAN通訊線最好雙絞。

并下載相關庫函數，導入我們的library文件夾中
CAN庫需要我們另外下載，下載渠道很多，這里貼一個下載鏈接：githubcom/sandeepmistry/arduino-CAN

四、電機ID使用usb2can轉換頭連接電腦，并進行如下設置：




五、運行代碼xm_motor.cpp

1. #include "xm_motor.h"
   
2. #include <Arduino.h>
   
3. MCP2515 mcp2515(10);
   
4. struct can_frame canMsg;
   
5. uint32_t ExtId;             //定義can擴展id
   
6. uint8_t rx_data[8];         //接收數據
   
7. uint32_t Motor_Can_ID;      //接收數據電機ID
   
8. static uint8_t byte_ls[4];  //轉換臨時數據
   
9. uint8_t tx_data[8];         //can寫入的數據
   
10. 
    
11. int filter(int queue[], char n)  //數值過濾
    
12. {
    
13.   int sum = 0;
    
14.   byte i;
    
15.   int maxsz = queue[0];  //尋找最大值
    
16.   int minsz = queue[0];  //尋找最小值
    
17.   for (i = 0; i < n; i++) {
    
18.     if (maxsz < queue[i]) { maxsz = queue[i]; }  //尋找最大值和最小值
    
19.     if (minsz > queue[i]) { minsz = queue[i]; }
    
20.   }
    
21. 
    
22.   for (i = 0; i < n; i++) {
    
23.     sum += queue[i];
    
24.   }
    
25.   sum = sum - maxsz - minsz;  //去除最大值和最小值
    
26.   return (sum / (n - 2));
    
27. }  //數值過濾
    
28. int check(byte ao_port, byte n)  //采樣
    
29. {
    
30. 
    
31.   int check_date[n];  //定義采樣數組
    
32.   for (byte i = 0; i < n; ++i) {
    
33.     check_date[i] = analogRead(ao_port);  //獲得指定傳感器數據
    
34.   }
    
35. 
    
36.   int vvvv = filter(check_date, n);
    
37.   return vvvv;
    
38. 
    
39. }  //采樣
    
40. void xm_can_start() {
    
41. 
    
42.   mcp2515.reset();
    
43.   mcp2515.setBitrate(CAN_1000KBPS, MCP_8MHZ);
    
44.   mcp2515.setNormalMode();
    
45.   delay(4);
    
46. }
    
47. static uint8_t* Float_to_Byte(float f)  //float分解成四個byte數據
    
48. {
    
49.   unsigned long longdata = 0;
    
50.   longdata = *(unsigned long*)&f;
    
51.   byte_ls[0] = (longdata & 0xFF000000) >> 24;
    
52.   byte_ls[1] = (longdata & 0x00FF0000) >> 16;
    
53.   byte_ls[2] = (longdata & 0x0000FF00) >> 8;
    
54.   byte_ls[3] = (longdata & 0x000000FF);
    
55.   return byte_ls;
    
56. }
    
57. static float uint16_to_float(uint16_t x, float x_min, float x_max, int bits)  //把uint 16位數據變成浮點數 用在接受數據的處理上
    
58. {
    
59.   uint32_t span = (1 << bits) - 1;
    
60.   float offset = x_max - x_min;
    
61.   return offset * x / span + x_min;
    
62. }
    
63. static int float_to_uint(float x, float x_min, float x_max, int bits)  //把浮點數轉換成uint_16 用在位置 扭矩 上面
    
64. {
    
65.   float span = x_max - x_min;
    
66.   float offset = x_min;
    
67.   if (x > x_max) x = x_max;
    
68.   else if (x < x_min) x = x_min;
    
69.   return (int)((x - offset) * ((float)((1 << bits) - 1)) / span);
    
70. }
    
71. void exid_count(uint8_t Communication_Type, uint16_t msid, uint8_t can_id)  //計算擴展ExtId,Communication_Type通信類型，msid主canid，
    
72. {
    
73.   uint8_t msid_l = msid;
    
74.   uint8_t msid_h = msid >> 8;
    
75.   uint32_t di_data = ((0xFFFFFFFF & Communication_Type) << 24) | 0x00FFFFFF;  //求出高32位
    
76.   uint32_t di_datab = ((0xFFFFFFFF & msid_h) << 16) | 0xFF00FFFF;             //求出高32位
    
77.   uint32_t di_datac = ((0xFFFFFFFF & msid_l) << 8) | 0xFFFF00FF;              //求出高32位
    
78.   uint32_t di_datad = (0xFFFFFFFF & can_id) | 0xFFFFFF00;                     //求出高32位
    
79.   ExtId = (di_data & di_datab & di_datac & di_datad);
    
80. }  //計算擴展ExtId,Communication_Type通信類型，msid主canid，
    
81. 
    
82. void data_count_dcs(uint16_t Index, float Value, char Value_type) {
    
83.   //計算can在 單參數寫入，通信類型 12下發送的8位數據，Index 是命令類型0: 運控模式1: 位置模式2: 速度模式3: 電流模式Value是0 值，Value_type是數據類型，浮點數用f非浮點用s
    
84.   //速度數值要 注明浮點數 f ,
    
85.   //寫入扭矩 n
    
86. 
    
87. 
    
88.   canMsg.data[0] = Index;
    
89.   canMsg.data[1] = Index >> 8;
    
90.   canMsg.data[2] = 0x00;
    
91.   canMsg.data[3] = 0x00;
    
92.   if (Value_type == 'f') {
    
93.     Float_to_Byte(Value);
    
94.     canMsg.data[4] = byte_ls[3];
    
95.     canMsg.data[5] = byte_ls[2];
    
96.     canMsg.data[6] = byte_ls[1];
    
97.     canMsg.data[7] = byte_ls[0];
    
98.   } else if (Value_type == 's') {
    
99.     canMsg.data[4] = (uint8_t)Value;
    
100.     canMsg.data[5] = 0x00;
     
101.     canMsg.data[6] = 0x00;
     
102.     canMsg.data[7] = 0x00;
     
103.   }
     
104. }  //計算can在 單參數寫入，通信類型 12下發送的8位數據，Index 是命令類型Value是值，Value_type是數據類型，浮點數用f非浮點用s
     
105. void data_count_zero()  //can數據置零
     
106. {
     
107.   canMsg.data[0] = 0x00;
     
108.   canMsg.data[1] = 0x00;
     
109.   canMsg.data[2] = 0x00;
     
110.   canMsg.data[3] = 0x00;
     
111.   canMsg.data[4] = 0x00;
     
112.   canMsg.data[5] = 0x00;
     
113.   canMsg.data[6] = 0x00;
     
114.   canMsg.data[7] = 0x00;
     
115. }  //can數據置零
     
116. 
     
117. void motor_enable(uint8_t id = 1)  //電機使能 電機canid
     
118. {
     
119.   exid_count(3, Master_CAN_ID, id);
     
120.   canMsg.can_id = ExtId | CAN_EFF_FLAG;
     
121.   canMsg.can_dlc = 8;
     
122.   data_count_zero();
     
123.   mcp2515.sendMessage(MCP2515::TXB1, &canMsg);
     
124.   delay(4);
     
125. }  //電機使能 電機canid
     
126. void motor_mode(uint8_t id, char type)  //電機運行模式 電機canid  模式值1位置模式2速度模式 3 電流模式0運控模式
     
127. {
     
128.   exid_count(0x12, Master_CAN_ID, CanID);
     
129.   canMsg.can_id = ExtId | CAN_EFF_FLAG;  //ExtId  0x12000001
     
130.   canMsg.can_dlc = 8;
     
131.   data_count_dcs(0x7005, type, 's');
     
132.   mcp2515.sendMessage(MCP2515::TXB1, &canMsg);
     
133.   delay(4);
     
134. }
     
135. 
     
136. void motor_speed_value(uint8_t id, float speed_ref) {  //設置速度模式下的參數轉速
     
137.   exid_count(0x12, Master_CAN_ID, CanID);
     
138.   canMsg.can_id = ExtId | CAN_EFF_FLAG;  //ExtId  0x12000001
     
139.   canMsg.can_dlc = 8;
     
140.   data_count_dcs(0x700A, speed_ref, 'f');
     
141.   mcp2515.sendMessage(MCP2515::TXB1, &canMsg);
     
142.   delay(4);
     
143. }
     
144. 
     
145. void motor_pos_zero(uint8_t id = 1)  //位置置0
     
146. {
     
147.   exid_count(6, Master_CAN_ID, id);
     
148.   canMsg.can_id = ExtId | CAN_EFF_FLAG;
     
149.   canMsg.can_dlc = 8;
     
150.   data_count_zero();
     
151.   canMsg.data[0] = 1;
     
152.   mcp2515.sendMessage(MCP2515::TXB1, &canMsg);
     
153.   delay(4);
     
154. 
     
155. }  //位置置0
     
156. void motor_pos_value(uint8_t id, float speed_ref) {  //設置位置模式下的位置
     
157.   exid_count(0x12, Master_CAN_ID, CanID);
     
158.   canMsg.can_id = ExtId | CAN_EFF_FLAG;  //ExtId  0x12000001
     
159.   canMsg.can_dlc = 8;
     
160.   data_count_dcs(0x7016, speed_ref, 'f');
     
161.   mcp2515.sendMessage(MCP2515::TXB1, &canMsg);
     
162.   delay(4);
     
163. }
     
164. 
     
165. void motor_pow_value(uint8_t id, float torque, float limit_cur, float kp = 1, float ki = 0.0158) {  //設置速度 電流限制，kp,kd
     
166.   exid_count(0x12, Master_CAN_ID, CanID);
     
167.   canMsg.can_id = ExtId | CAN_EFF_FLAG;  //ExtId  0x12000001
     
168.   canMsg.can_dlc = 8;
     
169.   data_count_dcs(0x7017, torque, 'f');
     
170.   mcp2515.sendMessage(MCP2515::TXB1, &canMsg);
     
171.   delay(4);
     
172.   data_count_dcs(0x7018, limit_cur, 'f');
     
173.   mcp2515.sendMessage(MCP2515::TXB1, &canMsg);
     
174.   delay(4);
     
175.   data_count_dcs(0x7010, kp, 'f');
     
176.   mcp2515.sendMessage(MCP2515::TXB1, &canMsg);
     
177.   delay(4);
     
178.   data_count_dcs(0x7011, ki, 'f');
     
179.   mcp2515.sendMessage(MCP2515::TXB1, &canMsg);
     
180.   delay(4);
     
181. }</font></font></font>

復制代碼

xm_motor.h

1. #include "Arduino.h"
   
2. #include <SPI.h>
   
3. #include "mcp2515.h"
   
4. 
   
5. #define pi 3.14159265359f
   
6. #define Communication_Type_MotorEnable 0x03
   
7. #define Master_CAN_ID 0x00
   
8. #define CanID 0x01
   
9. #define P_MIN -12.5f
   
10. #define P_MAX 12.5f
    
11. #define V_MIN -30.0f
    
12. #define V_MAX 30.0f
    
13. #define KP_MIN 0.0f
    
14. #define KP_MAX 500.0f
    
15. #define KD_MIN 0.0f
    
16. #define KD_MAX 5.0f
    
17. #define T_MIN -12.0f
    
18. #define T_MAX 12.0f
    
19. #define MAX_P 720
    
20. #define MIN_P -720
    
21. 
    
22. #define Communication_Type_GetID 0x00           //獲取設備的ID和64位MCU唯一標識符
    
23. #define Communication_Type_MotionControl 0x01         //用來向主機發送控制指令
    
24. #define Communication_Type_MotorRequest 0x02        //用來向主機反饋電機運行狀態
    
25. #define Communication_Type_MotorEnable 0x03            //電機使能運行
    
26. #define Communication_Type_MotorStop 0x04            //電機停止運行
    
27. #define Communication_Type_SetPosZero 0x06            //設置電機機械零位
    
28. #define Communication_Type_CanID 0x07                //更改當前電機CAN_ID
    
29. #define Communication_Type_Control_Mode 0x12
    
30. #define Communication_Type_GetSingleParameter 0x11        //讀取單個參數
    
31. #define Communication_Type_SetSingleParameter 0x12        //設定單個參數
    
32. #define Communication_Type_ErrorFeedback 0x15            //故障反饋幀
    
33. //參數讀取宏定義
    
34. #define Run_mode 0x7005        
    
35. #define Iq_Ref   0x7006
    
36. #define Spd_Ref  0x700A
    
37. #define Limit_Torque 0x700B
    
38. #define Cur_Kp 0x7010
    
39. #define Cur_Ki 0x7011
    
40. #define Cur_Filt_Gain 0x7014
    
41. #define Loc_Ref 0x7016
    
42. #define Limit_Spd 0x7017
    
43. #define Limit_Cur 0x7018
    
44. #define Gain_Angle 720/32767.0
    
45. #define Bias_Angle 0x8000
    
46. #define Gain_Speed 30/32767.0
    
47. #define Bias_Speed 0x8000
    
48. #define Gain_Torque 12/32767.0
    
49. #define Bias_Torque 0x8000
    
50. #define Temp_Gain   0.1
    
51. 
    
52. #define Motor_Error 0x00
    
53. #define Motor_OK 0X01
    
54. enum CONTROL_MODE   //控制模式定義
    
55. {
    
56.     Motion_mode = 0,//運控模式  
    
57.     Position_mode,  //位置模式
    
58.     Speed_mode,     //速度模式  
    
59.     Current_mode    //電流模式
    
60. };
    
61. enum ERROR_TAG      //錯誤回傳對照
    
62. {
    
63.     OK                 = 0,//無故障
    
64.     BAT_LOW_ERR        = 1,//欠壓故障
    
65.     OVER_CURRENT_ERR   = 2,//過流
    
66.     OVER_TEMP_ERR      = 3,//過溫
    
67.     MAGNETIC_ERR       = 4,//磁編碼故障
    
68.     HALL_ERR_ERR       = 5,//HALL編碼故障
    
69.     NO_CALIBRATION_ERR = 6//未標定
    
70. };
    
71. typedef struct{           //小米電機結構體
    
72.         uint8_t CAN_ID;       //CAN ID
    
73.     uint8_t MCU_ID;       //MCU唯一標識符【后8位，共64位】
    
74.         float Angle;          //回傳角度
    
75.         float Speed;          //回傳速度
    
76.         float Torque;         //回傳力矩
    
77.         float Temp;                          //回傳溫度
    
78.         
    
79.         uint16_t set_current;
    
80.         uint16_t set_speed;
    
81.         uint16_t set_position;
    
82.         
    
83.         uint8_t error_code;
    
84.         
    
85.         float Angle_Bias;
    
86.         
    
87. }MI_Motor;
    
88. extern MI_Motor mi_motor;//預先定義1個小米電機
    
89. 
    
90. void xm_can_start();
    
91. void motor_enable( uint8_t id=1 ) ;
    
92. void motor_mode( uint8_t id ,char type );
    
93. void motor_speed_value( uint8_t id ,float speed_ref );//-30rad-30rad
    
94. void motor_yk( uint8_t id ,float torque, float MechPosition, float speed, float kp, float kd );
    
95. void motor_pos_zero( uint8_t id=1 ); //位置置0
    
96. void motor_pos_value( uint8_t id ,float speed_ref );
    
97. void motor_pow_value( uint8_t id , float torque,float limit_cur ,float  kp,float kd );
    
98. 
    
99. int filter(int queue[], char n) ; //數值過濾
    
100. int check(byte ao_port, byte n); //獲取ad口電壓</font></font></font>

復制代碼

main.ino

1. #include "xm_motor.h"
   
2. String comdata = "";  //藍牙字符
   
3. void setup() {
   
4.   while (!Serial)
   
5.     ;
   
6.   Serial.begin(115200);
   
7. 
   
8.   xm_can_start();                         //初始化can設置
   
9.   motor_enable(1);                        //使能id 1電機
   
10.   motor_pos_zero(1);                      //位置置0
    
11.   motor_mode(1, 1);                       //電機運行模式 電機canid 模式值 1位置模式2速度模式 3 電流模式0運控模式
    
12.   motor_pow_value(1, 30, 20, 0.2, 0.13);  //uint8_t id , float torque 位置模式速度限制 ,float limit_cur ,float  kp=0.8,float ki=0.13  id 速度 電流限制，kp,kd  速度 0~30rad/s 6.28rad 等于1圈  電流最大23A
    
13.   Serial.println("Example: Write to CAN");
    
14. }
    
15. void loop() {
    
16. 
    
17.   int speed_value = 100;
    
18.   int speed_valueb = map(speed_value, 0, 1023, 0, 30);  //前進模擬量
    
19.   float bb = (float)speed_value;
    
20.   bb = bb / 163.9423;
    
21.   if (bb > 6.2) { bb = 6.2; }
    
22.   motor_pos_value(1, bb);          //電機位置模式賦值，id，位置角度rad 2派=360度。
    
23. 
    
24.   delay(20);
    
25. }

復制代碼

在main.ino中更改loop里speed_value的值即可更改角度，在0-1023范圍內進行更改。

---

作者: msold5    時間: 2024-4-26 22:55
之前我理解錯了，你說的雙絞線應該就是使用網線

---

作者: crowshuhale    時間: 2024-5-7 15:32
CAN Config Soft V2.3.9可以發一下嗎？

---

作者: 1003318346    時間: 2024-10-2 23:51
#include "mcp2515.h"

---

歡迎光臨 (http://www.zg4o1577.cn/bbs/)

Powered by Discuz! X3.1

感谢您访问我们的网站，您可能还对以下资源感兴趣：

久久久久久久999|99精品久久精品一区二区爱城|成人欧美一区二区三区在线播放|国产精品日本一区二区不卡视频|国产午夜视频|欧美精品在线观看免费

主站蜘蛛池模板： 国产精品1区2区 | 国产在线精品区 | 国产精品久久久久久久久免费桃花 | 久久99精品久久久久久国产越南 | 国产视频2021 | 欧洲av在线 | 亚洲手机视频在线 | 天天av网 | 国产剧情一区二区三区 | 欧美日韩在线视频观看 | 在线观看视频一区二区三区 | 一级片免费观看 | 国产亚洲欧美在线 | 超碰97人人人人人蜜桃 | 黄视频欧美 | 免费一级黄色录像 | 亚洲天堂色 | 免费黄网站在线观看 | 欧美日韩视频网站 | 国产女人精品视频 | 秋霞a级毛片在线看 | 日韩精品二区 | 一区二区三区视频免费看 | 毛片区 | 在线播放国产一区二区三区 | 91国内产香蕉| 欧美成人免费电影 | 精品国产一区二区国模嫣然 | 日韩色在线 | 国产高清视频在线观看 | 精久久久| 亚洲欧美中文字幕在线观看 | 亚洲欧美中文日韩在线 | 91av大全 | 国产免费一区二区三区 | 一级国产精品一级国产精品片 | 日韩一区二区在线观看 | 曰批视频在线观看 | 亚洲综合一区二区三区 | 精品成人免费一区二区在线播放 | 亚洲欧洲精品在线 |

<sup id="qoaei"><tbody id="qoaei"></tbody></sup>

<abbr id="qoaei"><code id="qoaei"></code></abbr>