设为首页收藏本站
首页 > 论坛 > Arduino

[项目]ESP32 麦克纳姆轮 视频车 精华

云天 | 初级技神 | 创造力： | 帖子： | 发消息 | 串个门 | 加好友 | 打招呼
2023-9-17 21:20:47 [显示全部楼层]
42210浏览
3回复
1收藏
查看: 42210|回复: 3

[项目] ESP32 麦克纳姆轮 视频车

[复制链接]
本帖最后由 云天 于 2023-9-17 21:28 编辑

ESP32 麦克纳姆轮 视频车图2
【项目背景】
想做一个组装简易的麦克纳姆轮视频车，之前制作的小车，电机需要驱动模块，也需要单独的电源，主控也需要电源。所以硬件设备较多，不好布局，很多时候显得很凌乱。在DF商城上看到了“Romeo ESP32-S3 开发板” Romeo ESP32-S3是为机器人项目设计的一款开发板，可驱动4路电机、图像传输、远程控制。
【项目设计】
ESP32 麦克纳姆轮 视频车图3
使用“便携式多路可调电源”的USB-A电源口为主控电源供电，9V端口为电机驱动供电。使用“ESPAsyncWebServer库”及“AsyncTCP库”，利用“App Inventor2”的浏览器模块访问192.168.4.1，即可实现手机App驱动小车和查看摄像头数据。

【硬件组装】

1.所用到硬件
ESP32 麦克纳姆轮 视频车图4
2.安装电机
ESP32 麦克纳姆轮 视频车图93.安装挡板
ESP32 麦克纳姆轮 视频车图10
4.安装麦克纳姆轮
ESP32 麦克纳姆轮 视频车图8
5.安装主控，接电机线
ESP32 麦克纳姆轮 视频车图6
6.安装电源
ESP32 麦克纳姆轮 视频车图7
7.接电源线
ESP32 麦克纳姆轮 视频车图5
8.固定摄像头
ESP32 麦克纳姆轮 视频车图1
【制作APP】
1.界面设计
一个网页浏览框和一个按钮
ESP32 麦克纳姆轮 视频车图11
2.程序设计
手机连接“Romeo ESP32-S3 开发板”的WIFI热点，网页浏览框加载“192.168.4.1”。按钮用于当连接中断时，重新连接。
ESP32 麦克纳姆轮 视频车图12
【修改ESP32示例代码】
ESP32 麦克纳姆轮 视频车图13
控制页面增加四个方向按钮
  1. 

  2.     <table id="mainTable" style="width:355px;margin:auto;table-layout:fixed" CELLSPACING=10>

  3.       <tr>

  4.         <img id="cameraImage" src="" style="width:355px;height:222px"></td>

  5.       </tr> 

  6.       <tr>

  7.         <td class="button" ontouchstart='sendButtonInput("MoveCar","5")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >↖</span></td>

  8.         <td class="button" ontouchstart='sendButtonInput("MoveCar","1")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >⇧</span></td>

  9.         <td class="button" ontouchstart='sendButtonInput("MoveCar","6")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >↗</span></td>

  10.       </tr>

  11.       <tr>

  12.         <td class="button" ontouchstart='sendButtonInput("MoveCar","3")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >⇦</span></td>

  13.         <td class="button"></td>    

  14.         <td class="button" ontouchstart='sendButtonInput("MoveCar","4")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >⇨</span></td>

  15.       </tr>

  16.       <tr>

  17.         <td class="button" ontouchstart='sendButtonInput("MoveCar","7")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >↙</span></td>

  18.         <td class="button" ontouchstart='sendButtonInput("MoveCar","2")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >⇩</span></td>

  19.         <td class="button" ontouchstart='sendButtonInput("MoveCar","8")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >↘</span></td>

  20.       </tr>

  21.       <tr/><tr/>

  22.       <tr>

  23.         <td style="text-align:left"><b>Speed:</b></td>

  24.         <td colspan=2>

  25.          <div class="slidecontainer">

  26.             <input type="range" min="0" max="100" value="50" class="slider" id="Speed" oninput='sendButtonInput("Speed",value)'>

  27.           </div>

  28.         </td>

  29.       </tr>        

  30. 

  31.     </table>

复制代码


根据麦克纳姆运动特点修改代码。轮麦克纳姆轮与普通轮子的区别在于麦克纳姆轮旋转时，由于存在斜向的从动轮，会同时产生一个斜向的力，当我们控制轮子旋转的速度与方向时，将斜向的力增强或抵消，从而实现小车的全向移动。可以完成横移、斜方向移动等普通小车无法完成的高难度动作，轮子的转动方向与小车的运动方向关系如下图：

  1. 

  2. void moveCar(uint8_t inputValue,uint8_t speed)

  3. {

  4.   switch(inputValue)

  5.   {

  6.     case UP:

  7.       retreat(1,speed);

  8.       retreat(2,speed);

  9.       advance(3,speed);

  10.       advance(4,speed);

  11.       break;

  12. 

  13.     case DOWN:

  14.       advance(1,speed);

  15.       advance(2,speed);

  16.       retreat(3,speed);

  17.       retreat(4,speed);

  18.       break;

  19. 

  20.     case LEFT:

  21.       retreat(2,speed);

  22.       retreat(4,speed);

  23.       advance(1,speed);

  24.       advance(3,speed);

  25.       break;

  26. 

  27.     case RIGHT:

  28.       retreat(1,speed);

  29.       retreat(3,speed);

  30.       advance(2,speed);

  31.       advance(4,speed);

  32.       break;

  33.     case Upper_Left:

  34.       breake(1);

  35.       retreat(2,speed);

  36.       advance(3,speed);

  37.       breake(4);

  38.       break;

  39.     case Upper_Right:

  40.       retreat(1,speed);

  41.       breake(2);

  42.       breake(3);

  43.       advance(4,speed);

  44.       break;

  45.     case Bottom_Left:

  46.       advance(1,speed);

  47.       breake(2);

  48.       breake(3);

  49.       retreat(4,speed);

  50.       break;

  51.     case Bottom_Right:

  52.       breake(1);

  53.       advance(2,speed);

  54.       retreat(3,speed);

  55.       breake(4);

  56.       break;

  57.     case STOP:

  58.       breake(1);

  59.       breake(2);

  60.       breake(3);

  61.       breake(4);

  62.       break;

  63.   }

  64. }

复制代码

【ESP32 完整代码】
  1. 

  2. #include "esp_camera.h"

  3. #include <Arduino.h>

  4. #include <WiFi.h>

  5. #include <AsyncTCP.h>

  6. #include <ESPAsyncWebServer.h>

  7. #include <iostream>

  8. #include <sstream>

  9. #include "DFRobot_AXP313A.h"

  10. #include "driver/mcpwm.h"

  11. #include "soc/mcpwm_struct.h" 

  12. #include "soc/mcpwm_reg.h"

  13. 

  14. DFRobot_AXP313A axp;

  15. 

  16. #define M1_EN 12

  17. #define M1_PN 13

  18. #define M2_EN 14

  19. #define M2_PN 21

  20. #define M3_EN 9

  21. #define M3_PN 10

  22. #define M4_EN 47

  23. #define M4_PN 11

  24. 

  25. 

  26. #define UP 1

  27. #define DOWN 2

  28. #define LEFT 3

  29. #define RIGHT 4

  30. #define Upper_Left 5

  31. #define Upper_Right 6

  32. #define Bottom_Left 7

  33. #define Bottom_Right 8

  34. #define STOP 0

  35. 

  36. #define FORWARD 1

  37. #define BACKWARD -1

  38. 

  39. //Camera related constants

  40. #define PWDN_GPIO_NUM     -1

  41. #define RESET_GPIO_NUM    -1

  42. #define XCLK_GPIO_NUM     45

  43. #define SIOD_GPIO_NUM     1

  44. #define SIOC_GPIO_NUM     2

  45. 

  46. #define Y9_GPIO_NUM       48

  47. #define Y8_GPIO_NUM       46

  48. #define Y7_GPIO_NUM       8

  49. #define Y6_GPIO_NUM       7

  50. #define Y5_GPIO_NUM       4

  51. #define Y4_GPIO_NUM       41

  52. #define Y3_GPIO_NUM       40

  53. #define Y2_GPIO_NUM       39

  54. #define VSYNC_GPIO_NUM    6

  55. #define HREF_GPIO_NUM     42

  56. #define PCLK_GPIO_NUM     5

  57. 

  58. const char* ssid     = "******";

  59. const char* password = "*******";

  60. 

  61. AsyncWebServer server(80);

  62. AsyncWebSocket wsCamera("/Camera");

  63. AsyncWebSocket wsCarInput("/CarInput");

  64. uint32_t cameraClientId = 0;

  65. 

  66. uint8_t Speed = 50;

  67. 

  68. const char* htmlHomePage PROGMEM = R"HTMLHOMEPAGE(

  69. <!DOCTYPE html>

  70. <html>

  71.   <head>

  72.   <meta name="viewport" content="width=device-width, initial-scale=1, maximum-scale=1, user-scalable=no">

  73.     <style>

  74.     .arrows {

  75.       font-size:30px;

  76.       color:red;

  77.     }

  78.     td.button {

  79.       background-color:black;

  80.       border-radius:25%;

  81.       box-shadow: 5px 5px #888888;

  82.     }

  83.     td.button:active {

  84.       transform: translate(5px,5px);

  85.       box-shadow: none; 

  86.     }

  87. 

  88.     .noselect {

  89.       -webkit-touch-callout: none; /* iOS Safari */

  90.         -webkit-user-select: none; /* Safari */

  91.          -khtml-user-select: none; /* Konqueror HTML */

  92.            -moz-user-select: none; /* Firefox */

  93.             -ms-user-select: none; /* Internet Explorer/Edge */

  94.                 user-select: none; /* Non-prefixed version, currently

  95.                                       supported by Chrome and Opera */

  96.     }

  97. 

  98.     .slidecontainer {

  99.       width: 100%;

  100.     }

  101. 

  102.     .slider {

  103.       -webkit-appearance: none;

  104.       width: 100%;

  105.       height: 15px;

  106.       border-radius: 5px;

  107.       background: #d3d3d3;

  108.       outline: none;

  109.       opacity: 0.7;

  110.       -webkit-transition: .2s;

  111.       transition: opacity .2s;

  112.     }

  113. 

  114.     .slider:hover {

  115.       opacity: 1;

  116.     }

  117. 

  118.     .slider::-webkit-slider-thumb {

  119.       -webkit-appearance: none;

  120.       appearance: none;

  121.       width: 25px;

  122.       height: 25px;

  123.       border-radius: 50%;

  124.       background: red;

  125.       cursor: pointer;

  126.     }

  127. 

  128.     .slider::-moz-range-thumb {

  129.       width: 25px;

  130.       height: 25px;

  131.       border-radius: 50%;

  132.       background: red;

  133.       cursor: pointer;

  134.     }

  135. 

  136.     </style>

  137. 

  138.   </head>

  139.   <body class="noselect" align="center" style="background-color:white">

  140.     <table id="mainTable" style="width:355px;margin:auto;table-layout:fixed" CELLSPACING=10>

  141.       <tr>

  142.         <img id="cameraImage" src="" style="width:355px;height:222px"></td>

  143.       </tr> 

  144.       <tr>

  145.         <td class="button" ontouchstart='sendButtonInput("MoveCar","5")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >↖</span></td>

  146.         <td class="button" ontouchstart='sendButtonInput("MoveCar","1")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >⇧</span></td>

  147.         <td class="button" ontouchstart='sendButtonInput("MoveCar","6")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >↗</span></td>

  148.       </tr>

  149.       <tr>

  150.         <td class="button" ontouchstart='sendButtonInput("MoveCar","3")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >⇦</span></td>

  151.         <td class="button"></td>    

  152.         <td class="button" ontouchstart='sendButtonInput("MoveCar","4")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >⇨</span></td>

  153.       </tr>

  154.       <tr>

  155.         <td class="button" ontouchstart='sendButtonInput("MoveCar","7")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >↙</span></td>

  156.         <td class="button" ontouchstart='sendButtonInput("MoveCar","2")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >⇩</span></td>

  157.         <td class="button" ontouchstart='sendButtonInput("MoveCar","8")' ontouchend='sendButtonInput("MoveCar","0")'><span class="arrows" >↘</span></td>

  158.       </tr>

  159.       <tr/><tr/>

  160.       <tr>

  161.         <td style="text-align:left"><b>Speed:</b></td>

  162.         <td colspan=2>

  163.          <div class="slidecontainer">

  164.             <input type="range" min="0" max="100" value="50" class="slider" id="Speed" oninput='sendButtonInput("Speed",value)'>

  165.           </div>

  166.         </td>

  167.       </tr>        

  168. 

  169.     </table>

  170. 

  171.     <script>

  172.       var webSocketCameraUrl = "ws:\/\/" + window.location.hostname + "/Camera";

  173.       var webSocketCarInputUrl = "ws:\/\/" + window.location.hostname + "/CarInput";      

  174.       var websocketCamera;

  175.       var websocketCarInput;

  176. 

  177.       function initCameraWebSocket() 

  178.       {

  179.         websocketCamera = new WebSocket(webSocketCameraUrl);

  180.         websocketCamera.binaryType = 'blob';

  181.         websocketCamera.onopen    = function(event){};

  182.         websocketCamera.onclose   = function(event){setTimeout(initCameraWebSocket, 2000);};

  183.         websocketCamera.onmessage = function(event)

  184.         {

  185.           var imageId = document.getElementById("cameraImage");

  186.           imageId.src = URL.createObjectURL(event.data);

  187.         };

  188.       }

  189. 

  190.       function initCarInputWebSocket() 

  191.       {

  192.         websocketCarInput = new WebSocket(webSocketCarInputUrl);

  193.         websocketCarInput.onopen    = function(event)

  194.         {

  195.           sendButtonInput("Speed", document.getElementById("Speed").value);

  196. 

  197.         };

  198.         websocketCarInput.onclose   = function(event){setTimeout(initCarInputWebSocket, 2000);};

  199.         websocketCarInput.onmessage = function(event){};        

  200.       }

  201. 

  202.       function initWebSocket() 

  203.       {

  204.         initCameraWebSocket ();

  205.         initCarInputWebSocket();

  206.       }

  207. 

  208.       function sendButtonInput(key, value) 

  209.       {

  210.         var data = key + "," + value;

  211.         websocketCarInput.send(data);

  212.       }

  213. 

  214.       window.onload = initWebSocket;

  215.       document.getElementById("mainTable").addEventListener("touchend", function(event){

  216.         event.preventDefault()

  217.       });      

  218.     </script>

  219.   </body>    

  220. </html>

  221. )HTMLHOMEPAGE";

  222. 

  223. 

  224. void advance(uint8_t motorNumber,uint8_t speed)

  225. {

  226.   switch(motorNumber)

  227.   {

  228.     case 1:

  229.       mcpwm_set_signal_high(MCPWM_UNIT_0,MCPWM_TIMER_0,MCPWM_GEN_B);//给PH一个持续的高电平

  230.       mcpwm_set_duty_type(MCPWM_UNIT_0,MCPWM_TIMER_0,MCPWM_GEN_A,MCPWM_DUTY_MODE_0);

  231.       mcpwm_set_duty(MCPWM_UNIT_0,MCPWM_TIMER_0,MCPWM_GEN_A,speed);//EN引脚输出占空比为“speed”的PWM波

  232.       break;

  233. 

  234.     case 2:

  235.       mcpwm_set_signal_high(MCPWM_UNIT_0,MCPWM_TIMER_1,MCPWM_GEN_B);//给PH一个持续的高电平

  236.       mcpwm_set_duty_type(MCPWM_UNIT_0,MCPWM_TIMER_1,MCPWM_GEN_A,MCPWM_DUTY_MODE_0);

  237.       mcpwm_set_duty(MCPWM_UNIT_0,MCPWM_TIMER_1,MCPWM_GEN_A,speed);//EN引脚输出占空比为“speed”的PWM波

  238.       break;

  239. 

  240.     case 3:

  241.       mcpwm_set_signal_high(MCPWM_UNIT_1,MCPWM_TIMER_0,MCPWM_GEN_B);//给PH一个持续的高电平

  242.       mcpwm_set_duty_type(MCPWM_UNIT_1,MCPWM_TIMER_0,MCPWM_GEN_A,MCPWM_DUTY_MODE_0);

  243.       mcpwm_set_duty(MCPWM_UNIT_1,MCPWM_TIMER_0,MCPWM_GEN_A,speed);//EN引脚输出占空比为“speed”的PWM波

  244.       break;

  245. 

  246.     case 4:

  247.       mcpwm_set_signal_high(MCPWM_UNIT_1,MCPWM_TIMER_1,MCPWM_GEN_B);//给PH一个持续的高电平

  248.       mcpwm_set_duty_type(MCPWM_UNIT_1,MCPWM_TIMER_1,MCPWM_GEN_A,MCPWM_DUTY_MODE_0);

  249.       mcpwm_set_duty(MCPWM_UNIT_1,MCPWM_TIMER_1,MCPWM_GEN_A,speed);//EN引脚输出占空比为“speed”的PWM波

  250.       break;

  251.   }

  252. }

  253. 

  254. void retreat(uint8_t motorNumber,uint8_t speed)

  255. {

  256.   switch(motorNumber)

  257.   {

  258.     case 1:

  259.       mcpwm_set_signal_low(MCPWM_UNIT_0,MCPWM_TIMER_0,MCPWM_GEN_B);//给PH一个持续的低电平

  260.       mcpwm_set_duty_type(MCPWM_UNIT_0,MCPWM_TIMER_0,MCPWM_GEN_A,MCPWM_DUTY_MODE_0);

  261.       mcpwm_set_duty(MCPWM_UNIT_0,MCPWM_TIMER_0,MCPWM_GEN_A,speed);//EN引脚输出占空比为“speed”的PWM波

  262.       break;

  263. 

  264.     case 2:

  265.       mcpwm_set_signal_low(MCPWM_UNIT_0,MCPWM_TIMER_1,MCPWM_GEN_B);//给PH一个持续的低电平

  266.       mcpwm_set_duty_type(MCPWM_UNIT_0,MCPWM_TIMER_1,MCPWM_GEN_A,MCPWM_DUTY_MODE_0);

  267.       mcpwm_set_duty(MCPWM_UNIT_0,MCPWM_TIMER_1,MCPWM_GEN_A,speed);//EN引脚输出占空比为“speed”的PWM波

  268.       break;

  269. 

  270.     case 3:

  271.       mcpwm_set_signal_low(MCPWM_UNIT_1,MCPWM_TIMER_0,MCPWM_GEN_B);//给PH一个持续的低电平

  272.       mcpwm_set_duty_type(MCPWM_UNIT_1,MCPWM_TIMER_0,MCPWM_GEN_A,MCPWM_DUTY_MODE_0);

  273.       mcpwm_set_duty(MCPWM_UNIT_1,MCPWM_TIMER_0,MCPWM_GEN_A,speed);//EN引脚输出占空比为“speed”的PWM波

  274.       break;

  275. 

  276.     case 4:

  277.       mcpwm_set_signal_low(MCPWM_UNIT_1,MCPWM_TIMER_1,MCPWM_GEN_B);//给PH一个持续的低电平

  278.       mcpwm_set_duty_type(MCPWM_UNIT_1,MCPWM_TIMER_1,MCPWM_GEN_A,MCPWM_DUTY_MODE_0);

  279.       mcpwm_set_duty(MCPWM_UNIT_1,MCPWM_TIMER_1,MCPWM_GEN_A,speed);//EN引脚输出占空比为“speed”的PWM波

  280.       break;

  281.   }

  282. }

  283. 

  284. void breake(uint8_t motorNumber)

  285. {

  286.   switch(motorNumber)

  287.   {

  288.     case 1:

  289.       mcpwm_set_signal_low(MCPWM_UNIT_0,MCPWM_TIMER_0,MCPWM_GEN_A);

  290.       break;

  291. 

  292.     case 2:

  293.       mcpwm_set_signal_low(MCPWM_UNIT_0,MCPWM_TIMER_1,MCPWM_GEN_A);

  294.       break;

  295. 

  296.     case 3:

  297.       mcpwm_set_signal_low(MCPWM_UNIT_1,MCPWM_TIMER_0,MCPWM_GEN_A);

  298.       break;

  299. 

  300.     case 4:

  301.       mcpwm_set_signal_low(MCPWM_UNIT_1,MCPWM_TIMER_1,MCPWM_GEN_A);

  302.       break;

  303.   }

  304. }

  305. 

  306. void moveCar(uint8_t inputValue,uint8_t speed)

  307. {

  308.   switch(inputValue)

  309.   {

  310.     case UP:

  311.       retreat(1,speed);

  312.       retreat(2,speed);

  313.       advance(3,speed);

  314.       advance(4,speed);

  315.       break;

  316. 

  317.     case DOWN:

  318.       advance(1,speed);

  319.       advance(2,speed);

  320.       retreat(3,speed);

  321.       retreat(4,speed);

  322.       break;

  323. 

  324.     case LEFT:

  325.       retreat(2,speed);

  326.       retreat(4,speed);

  327.       advance(1,speed);

  328.       advance(3,speed);

  329.       break;

  330. 

  331.     case RIGHT:

  332.       retreat(1,speed);

  333.       retreat(3,speed);

  334.       advance(2,speed);

  335.       advance(4,speed);

  336.       break;

  337.     case Upper_Left:

  338.       breake(1);

  339.       retreat(2,speed);

  340.       advance(3,speed);

  341.       breake(4);

  342.       break;

  343.     case Upper_Right:

  344.       retreat(1,speed);

  345.       breake(2);

  346.       breake(3);

  347.       advance(4,speed);

  348.       break;

  349.     case Bottom_Left:

  350.       advance(1,speed);

  351.       breake(2);

  352.       breake(3);

  353.       retreat(4,speed);

  354.       break;

  355.     case Bottom_Right:

  356.       breake(1);

  357.       advance(2,speed);

  358.       retreat(3,speed);

  359.       breake(4);

  360.       break;

  361.     case STOP:

  362.       breake(1);

  363.       breake(2);

  364.       breake(3);

  365.       breake(4);

  366.       break;

  367.   }

  368. }

  369. 

  370. void handleRoot(AsyncWebServerRequest *request) 

  371. {

  372.   request->send_P(200, "text/html", htmlHomePage);

  373. }

  374. 

  375. void handleNotFound(AsyncWebServerRequest *request) 

  376. {

  377.     request->send(404, "text/plain", "File Not Found");

  378. }

  379. 

  380. void onCarInputWebSocketEvent(AsyncWebSocket *server, 

  381.                       AsyncWebSocketClient *client, 

  382.                       AwsEventType type,

  383.                       void *arg, 

  384.                       uint8_t *data, 

  385.                       size_t len) 

  386. {                      

  387.   switch (type) 

  388.   {

  389.     case WS_EVT_CONNECT:

  390.       Serial.printf("WebSocket client #%u connected from %s\n", client->id(), client->remoteIP().toString().c_str());

  391.       break;

  392.     case WS_EVT_DISCONNECT:

  393.       Serial.printf("WebSocket client #%u disconnected\n", client->id());

  394.       moveCar(STOP,0);

  395.       //ledcWrite(PWMLightChannel, 0); 

  396.       //panServo.write(90);

  397.       //tiltServo.write(90);       

  398.       break;

  399.     case WS_EVT_DATA:

  400.       AwsFrameInfo *info;

  401.       info = (AwsFrameInfo*)arg;

  402.       if (info->final && info->index == 0 && info->len == len && info->opcode == WS_TEXT) 

  403.       {

  404.         std::string myData = "";

  405.         myData.assign((char *)data, len);

  406.         std::istringstream ss(myData);

  407.         std::string key, value;

  408.         std::getline(ss, key, ',');

  409.         std::getline(ss, value, ',');

  410.         Serial.printf("Key [%s] Value[%s]\n", key.c_str(), value.c_str()); 

  411.         int valueInt = atoi(value.c_str());     

  412.         if (key == "MoveCar")

  413.         {

  414.           moveCar(valueInt,Speed);        

  415.         }

  416.         else if (key == "Speed")

  417.         {

  418.           Speed = valueInt;

  419.         }

  420.         /*else if (key == "Light")

  421.         {

  422.           //ledcWrite(PWMLightChannel, valueInt);         

  423.         }

  424.         else if (key == "Pan")

  425.         {

  426.           //panServo.write(valueInt);

  427.         }

  428.         else if (key == "Tilt")

  429.         {

  430.           //tiltServo.write(valueInt);   

  431.         }  */           

  432.       }

  433.       break;

  434.     case WS_EVT_PONG:

  435.     case WS_EVT_ERROR:

  436.       break;

  437.     default:

  438.       break;  

  439.   }

  440. }

  441. 

  442. void onCameraWebSocketEvent(AsyncWebSocket *server, 

  443.                       AsyncWebSocketClient *client, 

  444.                       AwsEventType type,

  445.                       void *arg, 

  446.                       uint8_t *data, 

  447.                       size_t len) 

  448. {                      

  449.   switch (type) 

  450.   {

  451.     case WS_EVT_CONNECT:

  452.       Serial.printf("WebSocket client #%u connected from %s\n", client->id(), client->remoteIP().toString().c_str());

  453.       cameraClientId = client->id();

  454.       break;

  455.     case WS_EVT_DISCONNECT:

  456.       Serial.printf("WebSocket client #%u disconnected\n", client->id());

  457.       cameraClientId = 0;

  458.       break;

  459.     case WS_EVT_DATA:

  460.       break;

  461.     case WS_EVT_PONG:

  462.     case WS_EVT_ERROR:

  463.       break;

  464.     default:

  465.       break;  

  466.   }

  467. }

  468. 

  469. void setupCamera()

  470. {

  471.   camera_config_t config;

  472.   config.ledc_channel = LEDC_CHANNEL_0;

  473.   config.ledc_timer = LEDC_TIMER_0;

  474.   config.pin_d0 = Y2_GPIO_NUM;

  475.   config.pin_d1 = Y3_GPIO_NUM;

  476.   config.pin_d2 = Y4_GPIO_NUM;

  477.   config.pin_d3 = Y5_GPIO_NUM;

  478.   config.pin_d4 = Y6_GPIO_NUM;

  479.   config.pin_d5 = Y7_GPIO_NUM;

  480.   config.pin_d6 = Y8_GPIO_NUM;

  481.   config.pin_d7 = Y9_GPIO_NUM;

  482.   config.pin_xclk = XCLK_GPIO_NUM;

  483.   config.pin_pclk = PCLK_GPIO_NUM;

  484.   config.pin_vsync = VSYNC_GPIO_NUM;

  485.   config.pin_href = HREF_GPIO_NUM;

  486.   config.pin_sscb_sda = SIOD_GPIO_NUM;

  487.   config.pin_sscb_scl = SIOC_GPIO_NUM;

  488.   config.pin_pwdn = PWDN_GPIO_NUM;

  489.   config.pin_reset = RESET_GPIO_NUM;

  490.   config.xclk_freq_hz = 20000000;

  491.   config.frame_size = FRAMESIZE_UXGA;

  492.   config.pixel_format = PIXFORMAT_JPEG; // for streaming

  493.   //config.pixel_format = PIXFORMAT_RGB565; // for face detection/recognition

  494.   config.grab_mode = CAMERA_GRAB_WHEN_EMPTY;

  495.   config.fb_location = CAMERA_FB_IN_PSRAM;

  496.   config.jpeg_quality = 12;

  497.   config.fb_count = 1;

  498. 

  499.     // if PSRAM IC present, init with UXGA resolution and higher JPEG quality

  500.   //                      for larger pre-allocated frame buffer.

  501.   if(config.pixel_format == PIXFORMAT_JPEG){

  502.     if(psramFound()){

  503.       config.jpeg_quality = 10;

  504.       config.fb_count = 2;

  505.       config.grab_mode = CAMERA_GRAB_LATEST;

  506.     } else {

  507.       // Limit the frame size when PSRAM is not available

  508.       config.frame_size = FRAMESIZE_SVGA;

  509.       config.fb_location = CAMERA_FB_IN_DRAM;

  510.     }

  511.   } else {

  512.     // Best option for face detection/recognition

  513.     config.frame_size = FRAMESIZE_240X240;

  514. #if CONFIG_IDF_TARGET_ESP32S3

  515.     config.fb_count = 2;

  516. #endif

  517.   }

  518. 

  519. 

  520.   // camera init

  521.   esp_err_t err = esp_camera_init(&config);

  522.   if (err != ESP_OK) 

  523.   {

  524.     Serial.printf("Camera init failed with error 0x%x", err);

  525.     return;

  526.   }  

  527. 

  528.   if (psramFound())

  529.   {

  530.     heap_caps_malloc_extmem_enable(20000);  

  531.     Serial.printf("PSRAM initialized. malloc to take memory from psram above this size");    

  532.   }  

  533. }

  534. 

  535. void sendCameraPicture()

  536. {

  537.   if (cameraClientId == 0)

  538.   {

  539.     return;

  540.   }

  541.   unsigned long  startTime1 = millis();

  542.   //capture a frame

  543.   camera_fb_t * fb = esp_camera_fb_get();

  544.   if (!fb) 

  545.   {

  546.       Serial.println("Frame buffer could not be acquired");

  547.       return;

  548.   }

  549. 

  550.   unsigned long  startTime2 = millis();

  551.   wsCamera.binary(cameraClientId, fb->buf, fb->len);

  552.   esp_camera_fb_return(fb);

  553. 

  554.   //Wait for message to be delivered

  555.   while (true)

  556.   {

  557.     AsyncWebSocketClient * clientPointer = wsCamera.client(cameraClientId);

  558.     if (!clientPointer || !(clientPointer->queueIsFull()))

  559.     {

  560.       break;

  561.     }

  562.     delay(1);

  563.   }

  564. 

  565.   unsigned long  startTime3 = millis();  

  566.   Serial.printf("Time taken Total: %d|%d|%d\n",startTime3 - startTime1, startTime2 - startTime1, startTime3-startTime2 );

  567. }

  568. 

  569. //初始化需要产生PWM信号的引脚

  570. void mcpwm_init(void)

  571. {

  572.   //配置mcpwm信息

  573.   mcpwm_config_t pwm_config;

  574.   pwm_config.frequency = 1000;

  575.   pwm_config.cmpr_a = 0;

  576.   pwm_config.cmpr_b = 0;

  577.   pwm_config.counter_mode = MCPWM_UP_COUNTER;

  578.   pwm_config.duty_mode = MCPWM_DUTY_MODE_0;

  579. 

  580.   //A速度  B方向

  581.   mcpwm_gpio_init(MCPWM_UNIT_0,MCPWM0A,M1_EN);//电机1 GPIO

  582.   mcpwm_gpio_init(MCPWM_UNIT_0,MCPWM0B,M1_PN);

  583.   mcpwm_init(MCPWM_UNIT_0,MCPWM_TIMER_0,&pwm_config);//初始化mcpwm的某一个单元并绑定时钟

  584. 

  585.   mcpwm_gpio_init(MCPWM_UNIT_0,MCPWM1A,M2_EN);//电机2 GPIO

  586.   mcpwm_gpio_init(MCPWM_UNIT_0,MCPWM1B,M2_PN);

  587.   mcpwm_init(MCPWM_UNIT_0,MCPWM_TIMER_1,&pwm_config);//初始化mcpwm的某一个单元并绑定时钟

  588. 

  589.   mcpwm_gpio_init(MCPWM_UNIT_1,MCPWM0A,M3_EN);//电机3 GPIO

  590.   mcpwm_gpio_init(MCPWM_UNIT_1,MCPWM0B,M3_PN);

  591.   mcpwm_init(MCPWM_UNIT_1,MCPWM_TIMER_0,&pwm_config);//初始化mcpwm的某一个单元并绑定时钟

  592. 

  593.   mcpwm_gpio_init(MCPWM_UNIT_1,MCPWM1A,M4_EN);//电机4 GPIO

  594.   mcpwm_gpio_init(MCPWM_UNIT_1,MCPWM1B,M4_PN);

  595.   mcpwm_init(MCPWM_UNIT_1,MCPWM_TIMER_1,&pwm_config);//初始化mcpwm的某一个单元并绑定时钟

  596. }

  597. 

  598. 

  599. void setup(void) 

  600. {

  601.   Serial.begin(115200);

  602.   while(axp.begin() != 0){

  603.     Serial.println("init error");

  604.     delay(1000);

  605.   }

  606.   axp.enableCameraPower(axp.eOV2640);//设置摄像头供电

  607.   mcpwm_init();

  608. 

  609.   WiFi.softAP(ssid, password);

  610.   IPAddress IP = WiFi.softAPIP();

  611.   Serial.print("AP IP address: ");

  612.   Serial.println(IP);

  613. 

  614.   server.on("/", HTTP_GET, handleRoot);

  615.   server.onNotFound(handleNotFound);

  616. 

  617.   wsCamera.onEvent(onCameraWebSocketEvent);

  618.   server.addHandler(&wsCamera);

  619. 

  620.   wsCarInput.onEvent(onCarInputWebSocketEvent);

  621.   server.addHandler(&wsCarInput);

  622. 

  623.   server.begin();

  624.   Serial.println("HTTP server started");

  625. 

  626.   setupCamera();

  627. }

  628. 

  629. 

  630. void loop() 

  631. {

  632.   wsCamera.cleanupClients(); 

  633.   wsCarInput.cleanupClients(); 

  634.   sendCameraPicture(); 

  635.   //Serial.printf("SPIRam Total heap %d, SPIRam Free Heap %d\n", ESP.getPsramSize(), ESP.getFreePsram());

  636. }

复制代码

ESP32 麦克纳姆轮 视频车图14ESP32 麦克纳姆轮 视频车图15ESP32 麦克纳姆轮 视频车图16
【演示视频】


回复

使用道具 举报

精彩评论(3)

_深蓝_  中级技师 来自手机

发表于 2023-9-24 15:14:52

云片出品，必属精品！！！
回复

使用道具 举报

Amos Young  中级技师

发表于 2023-10-4 14:54:38

这个创意有趣，云天老师好帅！
回复

使用道具 举报

曾剑波  初级技匠

发表于 2023-11-8 00:48:30

这个不错哦！值得研究一下
回复

使用道具 举报

高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

为本项目制作心愿单
购买心愿单
心愿单 编辑
[[wsData.name]]

硬件清单

  • [[d.name]]
btnicon
我也要做!
点击进入购买页面
撰写新帖
关于楼主
勋章墙
活跃会员 宣传大使 创客造 编辑选择奖 志“童”道合 编辑选择奖 编辑选择奖

楼主的其它帖子

background 创造力兑换 background 心愿单 background 创客导航
上海智位机器人股份有限公司 沪ICP备09038501号-4

© 2013-2024 Comsenz Inc. Powered by Discuz! X3.4 Licensed

mail