{"id":62864,"date":"2026-01-20T20:26:22","date_gmt":"2026-01-20T12:26:22","guid":{"rendered":"https:\/\/www.wsisp.com\/helps\/62864.html"},"modified":"2026-01-20T20:26:22","modified_gmt":"2026-01-20T12:26:22","slug":"%e3%80%90%e8%8a%b1%e9%9b%95%e5%ad%a6%e7%bc%96%e7%a8%8b%e3%80%91arduino-bldc-%e4%b9%8b%e5%8c%bb%e7%96%97%e5%8a%a9%e8%a1%8c%e5%a4%96%e9%aa%a8%e9%aa%bc%e6%9c%ba%e5%99%a8%e4%ba%ba","status":"publish","type":"post","link":"https:\/\/www.wsisp.com\/helps\/62864.html","title":{"rendered":"\u3010\u82b1\u96d5\u5b66\u7f16\u7a0b\u3011Arduino BLDC \u4e4b\u533b\u7597\u52a9\u884c\u5916\u9aa8\u9abc\u673a\u5668\u4eba"},"content":{"rendered":"<p><img decoding=\"async\" src=\"https:\/\/www.wsisp.com\/helps\/wp-content\/uploads\/2026\/01\/20260120122620-696f746c03ba2.gif\" alt=\"\u5728\u8fd9\u91cc\u63d2\u5165\u56fe\u7247\u63cf\u8ff0\" \/><br \/>\n\u8fd9\u662f\u4e00\u4e2a\u9ad8\u5ea6\u8de8\u5b66\u79d1\u7684\u524d\u6cbf\u5e94\u7528&#xff0c;\u878d\u5408\u4e86\u5d4c\u5165\u5f0f\u7cfb\u7edf\u3001\u9ad8\u6548\u7535\u673a\u9a71\u52a8\u3001\u751f\u7269\u529b\u5b66\u3001\u5eb7\u590d\u533b\u5b66\u3001\u4eba\u673a\u4ea4\u4e92\u548c\u4f20\u611f\u5668\u6280\u672f\u3002\u5176\u6838\u5fc3\u76ee\u6807\u662f\u4e3a\u4e0b\u80a2\u529f\u80fd\u969c\u788d\u8005&#xff08;\u5982\u4e2d\u98ce\u60a3\u8005\u3001\u810a\u9ad3\u635f\u4f24\u60a3\u8005\u3001\u8001\u5e74\u4eba&#xff09;\u63d0\u4f9b\u8f85\u52a9\u884c\u8d70\u3001\u652f\u6491\u4f53\u91cd\u3001\u52a9\u529b\u6216\u963b\u529b\u8bad\u7ec3\u7b49\u529f\u80fd\u3002<br \/>\n\u4e00\u3001 \u4e3b\u8981\u7279\u70b9 (Key Features)<br \/>\n\u9ad8\u6548\u3001\u9ad8\u626d\u77e9\u9a71\u52a8\u7cfb\u7edf (High-Efficiency, High-Torque Drive System):<br \/>\n\u6838\u5fc3: \u91c7\u7528BLDC\u7535\u673a\u4f5c\u4e3a\u5173\u8282\u9a71\u52a8\u5668&#xff0c;\u901a\u8fc7\u51cf\u901f\u5668\u8fde\u63a5\u5230\u9acb\u5173\u8282\u3001\u819d\u5173\u8282\u7b49\u90e8\u4f4d\u3002<br \/>\n\u529f\u80fd:<br \/>\n\u9ad8\u6548\u7387: \u76f8\u6bd4\u6709\u5237\u7535\u673a&#xff0c;BLDC\u6548\u7387\u66f4\u9ad8&#xff0c;\u6709\u52a9\u4e8e\u5ef6\u957f\u7535\u6c60\u7eed\u822a&#xff0c;\u5bf9\u4e8e\u9700\u8981\u957f\u65f6\u95f4\u4f7f\u7528\u7684\u52a9\u884c\u8bbe\u5907\u81f3\u5173\u91cd\u8981\u3002<br \/>\n\u9ad8\u626d\u77e9\/\u529f\u7387\u5bc6\u5ea6: \u80fd\u591f\u63d0\u4f9b\u8db3\u591f\u7684\u9a71\u52a8\u529b\u77e9\u6765\u652f\u6491\u4eba\u4f53\u91cd\u91cf\u5e76\u8f85\u52a9\u884c\u8d70&#xff0c;\u540c\u65f6\u4fdd\u6301\u76f8\u5bf9\u7d27\u51d1\u7684\u7ed3\u6784\u3002<br \/>\n\u7cbe\u786e\u63a7\u5236: \u53ef\u5b9e\u73b0\u7cbe\u786e\u7684\u901f\u5ea6\u3001\u4f4d\u7f6e\u548c\u529b\u77e9\u63a7\u5236&#xff0c;\u6ee1\u8db3\u4e0d\u540c\u5eb7\u590d\u6a21\u5f0f\u7684\u9700\u6c42&#xff08;\u5982\u88ab\u52a8\u8bad\u7ec3\u3001\u4e3b\u52a8\u8f85\u52a9\u3001\u6297\u963b\u8bad\u7ec3&#xff09;\u3002<br \/>\n\u957f\u5bff\u547d: \u65e0\u7535\u5237\u78e8\u635f&#xff0c;\u63d0\u9ad8\u4e86\u7cfb\u7edf\u7684\u53ef\u9760\u6027\u548c\u7ef4\u62a4\u95f4\u9694\u3002<br \/>\n\u591a\u6a21\u6001\u5eb7\u590d\u7b56\u7565 (Multi-Modal Rehabilitation Strategy):<br \/>\n\u6838\u5fc3: \u7cfb\u7edf\u80fd\u591f\u6839\u636e\u60a3\u8005\u7684\u5eb7\u590d\u9636\u6bb5\u548c\u533b\u751f\u5904\u65b9&#xff0c;\u63d0\u4f9b\u591a\u79cd\u8f85\u52a9\u6a21\u5f0f\u3002<br \/>\n\u529f\u80fd:<br \/>\n\u88ab\u52a8\u6a21\u5f0f (Passive Mode): \u673a\u5668\u4eba\u5e26\u52a8\u60a3\u8005\u817f\u90e8\u5b8c\u6210\u6b65\u6001\u5468\u671f&#xff0c;\u4e3b\u8981\u7528\u4e8e\u65e9\u671f\u5eb7\u590d&#xff0c;\u5e2e\u52a9\u7ef4\u6301\u5173\u8282\u6d3b\u52a8\u5ea6&#xff0c;\u9632\u6b62\u808c\u8089\u840e\u7f29\u3002<br \/>\n\u4e3b\u52a8\u8f85\u52a9\u6a21\u5f0f (Active-Assist Mode): \u673a\u5668\u4eba\u611f\u77e5\u60a3\u8005\u7684\u610f\u56fe&#xff08;\u901a\u8fc7\u808c\u7535\u4fe1\u53f7\u3001\u529b\/\u529b\u77e9\u4f20\u611f\u5668\u3001\u5173\u8282\u89d2\u5ea6\u53d8\u5316\u7b49&#xff09;&#xff0c;\u5e76\u5728\u60a3\u8005\u529b\u91cf\u4e0d\u8db3\u65f6\u7ed9\u4e88\u9002\u91cf\u8f85\u52a9&#xff0c;\u9f13\u52b1\u60a3\u8005\u4e3b\u52a8\u53c2\u4e0e\u3002<br \/>\n\u6297\u963b\u8bad\u7ec3\u6a21\u5f0f (Resistance Training Mode): \u673a\u5668\u4eba\u63d0\u4f9b\u4e0e\u60a3\u8005\u8fd0\u52a8\u65b9\u5411\u76f8\u53cd\u7684\u963b\u529b&#xff0c;\u7528\u4e8e\u589e\u5f3a\u808c\u8089\u529b\u91cf\u548c\u8010\u529b\u3002<br \/>\n\u652f\u6491\/\u7ad9\u7acb\u6a21\u5f0f (Stand\/Sit Support Mode): \u5728\u5750\u7ad9\u8f6c\u6362\u6216\u7ad9\u7acb\u65f6\u63d0\u4f9b\u90e8\u5206\u4f53\u91cd\u652f\u6491\u3002<br \/>\n\u667a\u80fd\u610f\u56fe\u8bc6\u522b\u4e0e\u4eba\u673a\u4ea4\u4e92 (Intelligent Intention Recognition &amp; Human-Machine Interaction):<br \/>\n\u6838\u5fc3: \u901a\u8fc7\u591a\u79cd\u4f20\u611f\u5668&#xff08;\u5982\u808c\u7535\u4fe1\u53f7\u4f20\u611f\u5668EMG\u3001\u8db3\u5e95\u538b\u529b\u4f20\u611f\u5668\u3001\u5173\u8282\u7f16\u7801\u5668\u3001IMU\u3001\u529b\/\u529b\u77e9\u4f20\u611f\u5668&#xff09;\u611f\u77e5\u7528\u6237\u7684\u8fd0\u52a8\u610f\u56fe\u548c\u8eab\u4f53\u72b6\u6001\u3002<br \/>\n\u529f\u80fd: \u5b9e\u65f6\u5224\u65ad\u7528\u6237\u662f\u60f3\u5750\u4e0b\u3001\u7ad9\u7acb\u3001\u8fc8\u6b65\u3001\u8f6c\u5f2f\u8fd8\u662f\u505c\u6b62&#xff0c;\u5e76\u76f8\u5e94\u5730\u8c03\u6574\u673a\u5668\u4eba\u7684\u63a7\u5236\u7b56\u7565&#xff0c;\u4f7f\u8f85\u52a9\u66f4\u52a0\u81ea\u7136\u3001\u8212\u9002\u3001\u5b89\u5168\u3002\u826f\u597d\u7684\u4eba\u673a\u4ea4\u4e92\u754c\u9762&#xff08;\u5982\u663e\u793a\u5c4f\u3001\u8bed\u97f3\u63d0\u793a\u3001\u6309\u94ae&#xff09;\u4e5f\u662f\u5173\u952e\u3002<br \/>\n\u6b65\u6001\u5206\u6790\u4e0e\u6570\u636e\u8bb0\u5f55 (Gait Analysis &amp; Data Logging):<br \/>\n\u6838\u5fc3: Arduino&#xff08;\u6216\u66f4\u5f3a\u5927\u7684\u4e3b\u63a7&#xff09;\u8bb0\u5f55\u548c\u5206\u6790\u5173\u8282\u89d2\u5ea6\u3001\u901f\u5ea6\u3001\u529b\u77e9\u3001\u6b65\u957f\u3001\u6b65\u9891\u3001\u884c\u8d70\u8ddd\u79bb\u7b49\u6570\u636e\u3002<br \/>\n\u529f\u80fd: \u4e3a\u533b\u751f\u548c\u6cbb\u7597\u5e08\u63d0\u4f9b\u5ba2\u89c2\u7684\u5eb7\u590d\u8fdb\u5c55\u8bc4\u4f30\u4f9d\u636e&#xff0c;\u5e2e\u52a9\u8c03\u6574\u8bad\u7ec3\u8ba1\u5212\u3002\u6570\u636e\u4e5f\u53ef\u7528\u4e8e\u7b97\u6cd5\u4f18\u5316\u548c\u8fdc\u7a0b\u76d1\u63a7\u3002<br \/>\n\u5b89\u5168\u4fdd\u62a4\u673a\u5236 (Safety Protection Mechanisms):<br \/>\n\u6838\u5fc3: \u5185\u7f6e\u591a\u79cd\u5b89\u5168\u63aa\u65bd&#xff0c;\u9632\u6b62\u610f\u5916\u53d1\u751f\u3002<br \/>\n\u529f\u80fd:<br \/>\n\u529b\u77e9\/\u7535\u6d41\u9650\u5236: \u9632\u6b62\u8f93\u51fa\u8fc7\u5927\u529b\u77e9\u4f24\u53ca\u7528\u6237\u3002<br \/>\n\u7d27\u6025\u505c\u6b62: \u7269\u7406\u6025\u505c\u6309\u94ae\u6216\u901a\u8fc7\u4f20\u611f\u5668\u68c0\u6d4b\u5f02\u5e38\u60c5\u51b5&#xff08;\u5982\u6454\u5012\u8ff9\u8c61&#xff09;\u89e6\u53d1\u6025\u505c\u3002<br \/>\n\u8dcc\u5012\u68c0\u6d4b\u4e0e\u4fdd\u62a4: \u901a\u8fc7IMU\u3001\u59ff\u6001\u4f20\u611f\u5668\u6216\u8db3\u5e95\u538b\u529b\u4f20\u611f\u5668\u68c0\u6d4b\u5931\u8861&#xff0c;\u91c7\u53d6\u63aa\u65bd&#xff08;\u5982\u589e\u52a0\u652f\u6491\u3001\u62a5\u8b66&#xff09;\u3002<br \/>\n\u5173\u8282\u9650\u4f4d: \u9632\u6b62\u5173\u8282\u8fd0\u52a8\u8d85\u51fa\u5b89\u5168\u8303\u56f4\u3002<br \/>\n\u78b0\u649e\u68c0\u6d4b: \u611f\u77e5\u5916\u90e8\u78b0\u649e\u5e76\u505a\u51fa\u53cd\u5e94\u3002<br \/>\n\u6a21\u5757\u5316\u4e0e\u53ef\u8c03\u8282\u8bbe\u8ba1 (Modular and Adjustable Design):<br \/>\n\u6838\u5fc3: \u5916\u9aa8\u9abc\u7ed3\u6784\u5e94\u80fd\u9002\u5e94\u4e0d\u540c\u8eab\u9ad8\u3001\u4f53\u578b\u7684\u7528\u6237\u3002<br \/>\n\u529f\u80fd: \u5173\u8282\u8fde\u63a5\u4ef6\u3001\u8fde\u6746\u957f\u5ea6\u53ef\u8c03\u8282&#xff0c;\u4ee5\u786e\u4fdd\u7a7f\u6234\u8212\u9002\u3001\u8d34\u5408&#xff0c;\u529b\u4f20\u9012\u8def\u5f84\u6b63\u786e\u3002<br \/>\n\u4e8c\u3001 \u5e94\u7528\u573a\u666f (Application Scenarios)<br \/>\n\u533b\u7597\u673a\u6784\u5eb7\u590d\u79d1 (Rehabilitation Departments in Hospitals\/Clinics):<br \/>\n\u7528\u9014: \u4f5c\u4e3a\u91cd\u8981\u7684\u5eb7\u590d\u8bad\u7ec3\u8bbe\u5907&#xff0c;\u7528\u4e8e\u4e2d\u98ce\u3001\u810a\u9ad3\u635f\u4f24\u3001\u8111\u762b\u7b49\u60a3\u8005\u7684\u6b65\u884c\u529f\u80fd\u91cd\u5efa\u8bad\u7ec3\u3002<br \/>\n\u4ef7\u503c: \u63d0\u9ad8\u5eb7\u590d\u6548\u7387&#xff0c;\u51cf\u8f7b\u6cbb\u7597\u5e08\u4f53\u529b\u8d1f\u62c5&#xff0c;\u63d0\u4f9b\u6807\u51c6\u5316\u3001\u53ef\u91cf\u5316\u3001\u9ad8\u5f3a\u5ea6\u7684\u8bad\u7ec3\u3002<br \/>\n\u517b\u8001\u9662\u4e0e\u62a4\u7406\u673a\u6784 (Nursing Homes &amp; Care Facilities):<br \/>\n\u7528\u9014: \u4e3a\u884c\u52a8\u4e0d\u4fbf\u7684\u8001\u5e74\u4eba\u63d0\u4f9b\u65e5\u5e38\u52a9\u884c\u652f\u6301&#xff0c;\u5ef6\u7f13\u808c\u8089\u840e\u7f29&#xff0c;\u6539\u5584\u5fc3\u80ba\u529f\u80fd&#xff0c;\u63d0\u5347\u751f\u6d3b\u8d28\u91cf\u3002<br \/>\n\u4ef7\u503c: \u589e\u5f3a\u8001\u4eba\u72ec\u7acb\u6027&#xff0c;\u51cf\u5c11\u62a4\u7406\u4eba\u5458\u5de5\u4f5c\u5f3a\u5ea6\u3002<br \/>\n\u5bb6\u5ead\u5eb7\u590d (Home-Based Rehabilitation &#8211; Emerging):<br \/>\n\u7528\u9014: \u5bf9\u4e8e\u90e8\u5206\u75c5\u60c5\u7a33\u5b9a\u3001\u5177\u5907\u4e00\u5b9a\u81ea\u4e3b\u6d3b\u52a8\u80fd\u529b\u7684\u60a3\u8005&#xff0c;\u53ef\u5728\u5bb6\u5ead\u73af\u5883\u4e2d\u8fdb\u884c\u8f85\u52a9\u8bad\u7ec3\u6216\u65e5\u5e38\u52a9\u884c\u3002<br \/>\n\u4ef7\u503c: \u65b9\u4fbf\u60a3\u8005&#xff0c;\u964d\u4f4e\u5eb7\u590d\u6210\u672c&#xff0c;\u5b9e\u73b0\u957f\u671f\u6301\u7eed\u8bad\u7ec3\u3002<br \/>\n\u79d1\u7814\u4e0e\u4e34\u5e8a\u8bd5\u9a8c (Research &amp; Clinical Trials):<br \/>\n\u7528\u9014: \u4f5c\u4e3a\u7814\u7a76\u5e73\u53f0&#xff0c;\u63a2\u7d22\u65b0\u7684\u5eb7\u590d\u7406\u8bba\u3001\u8bc4\u4f30\u4e0d\u540c\u5eb7\u590d\u7b56\u7565\u7684\u6548\u679c\u3001\u5f00\u53d1\u66f4\u5148\u8fdb\u7684\u63a7\u5236\u7b97\u6cd5\u3002<br \/>\n\u4ef7\u503c: \u63a8\u52a8\u5eb7\u590d\u533b\u5b66\u53d1\u5c55\u3002<br \/>\n\u4e09\u3001 \u9700\u8981\u6ce8\u610f\u7684\u4e8b\u9879 (Considerations &amp; Critical Challenges)<br \/>\n\u5b89\u5168\u81f3\u4e0a\u7684\u8bbe\u8ba1\u539f\u5219 (Safety-First Design Principle):<br \/>\n\u95ee\u9898: \u8fd9\u662f\u6700\u91cd\u8981\u7684\u8003\u91cf\u3002\u4efb\u4f55\u7cfb\u7edf\u6545\u969c\u3001\u63a7\u5236\u5931\u8bef\u6216\u673a\u68b0\u95ee\u9898\u90fd\u53ef\u80fd\u5bfc\u81f4\u7528\u6237\u4e25\u91cd\u53d7\u4f24\u751a\u81f3\u6b7b\u4ea1\u3002<br \/>\n\u5bf9\u7b56:<br \/>\n\u4e25\u683c\u9075\u5faa\u533b\u7597\u5668\u68b0\u76f8\u5173\u7684\u5b89\u5168\u6807\u51c6&#xff08;\u5982IEC 60601\u7cfb\u5217&#xff09;\u8fdb\u884c\u8bbe\u8ba1\u548c\u6d4b\u8bd5\u3002<br \/>\n\u91c7\u7528\u5197\u4f59\u4f20\u611f\u5668\u548c\u5b89\u5168\u56de\u8def\u3002<br \/>\n\u8fdb\u884c\u5168\u9762\u7684\u3001\u4e25\u683c\u7684\u751f\u7269\u76f8\u5bb9\u6027\u3001\u7535\u6c14\u5b89\u5168\u3001\u673a\u68b0\u5b89\u5168\u3001\u7535\u78c1\u517c\u5bb9\u6027&#xff08;EMC&#xff09;\u6d4b\u8bd5\u3002<br \/>\n\u5fc5\u987b\u6709\u7ecf\u8fc7\u57f9\u8bad\u7684\u4e13\u4e1a\u4eba\u5458\u5728\u573a\u76d1\u7763\u4f7f\u7528\u3002<br \/>\n\u8003\u8651\u7533\u8bf7\u533b\u7597\u5668\u68b0\u8ba4\u8bc1&#xff08;\u5982FDA\u3001CE\u8ba4\u8bc1&#xff09;\u3002<br \/>\nArduino\u5e73\u53f0\u7684\u5c40\u9650\u6027 (Limitations of the Arduino Platform):<br \/>\n\u95ee\u9898:<br \/>\n\u8ba1\u7b97\u80fd\u529b: \u7ecf\u5178Arduino&#xff08;\u5982Uno&#xff09;\u5904\u7406\u80fd\u529b\u4e25\u91cd\u4e0d\u8db3&#xff0c;\u96be\u4ee5\u8fd0\u884c\u590d\u6742\u7684\u610f\u56fe\u8bc6\u522b\u7b97\u6cd5\u3001\u591a\u4f20\u611f\u5668\u878d\u5408\u3001\u9ad8\u7ea7\u63a7\u5236\u7406\u8bba&#xff08;\u5982\u81ea\u9002\u5e94\u63a7\u5236\u3001\u6a21\u578b\u9884\u6d4b\u63a7\u5236MPC&#xff09;\u6216\u5b9e\u65f6\u6b65\u6001\u5206\u6790\u3002<br \/>\n\u63a5\u53e3: I\/O\u53e3\u6570\u91cf\u53ef\u80fd\u4e0d\u591f&#xff0c;\u96be\u4ee5\u8fde\u63a5\u591a\u4e2a\u9ad8\u7cbe\u5ea6\u4f20\u611f\u5668&#xff08;\u5982\u591a\u8f74\u529b\/\u529b\u77e9\u4f20\u611f\u5668\u3001\u808c\u7535\u4f20\u611f\u5668\u3001\u7f16\u7801\u5668&#xff09;\u3002<br \/>\n\u5b9e\u65f6\u6027: Arduino\u7684\u5b9e\u65f6\u64cd\u4f5c\u7cfb\u7edf\u80fd\u529b\u6709\u9650&#xff0c;\u96be\u4ee5\u4fdd\u8bc1\u4e25\u683c\u7684\u63a7\u5236\u5468\u671f\u3002<br \/>\n\u5bf9\u7b56:<br \/>\n\u9009\u7528\u66f4\u5f3a\u7684\u4e3b\u63a7: \u66f4\u73b0\u5b9e\u7684\u9009\u62e9\u662f\u4f7f\u7528\u9ad8\u6027\u80fd\u5355\u7247\u673a&#xff08;\u5982STM32H7\u7cfb\u5217&#xff09;\u3001\u5d4c\u5165\u5f0fLinux\u5e73\u53f0&#xff08;\u5982\u6811\u8393\u6d3e\u3001NVIDIA Jetson Nano\/Orin Nano&#xff09;\u6216\u4e13\u95e8\u7684\u673a\u5668\u4eba\u63a7\u5236\u5668\u3002<br \/>\n\u5206\u5c42\u63a7\u5236: Arduino\u53ef\u4ee5\u4f5c\u4e3a\u5e95\u5c42\u6267\u884c\u5668\u6216\u4f20\u611f\u5668\u63a5\u53e3&#xff0c;\u7531\u66f4\u5f3a\u5927\u7684\u4e0a\u4f4d\u673a&#xff08;\u5982\u6811\u8393\u6d3e&#xff09;\u8fdb\u884c\u9ad8\u5c42\u51b3\u7b56\u548c\u590d\u6742\u8ba1\u7b97\u3002<br \/>\n\u751f\u7269\u529b\u5b66\u4e0e\u4eba\u4f53\u5de5\u7a0b\u5b66\u9002\u914d (Biomechanics &amp; Ergonomics):<br \/>\n\u95ee\u9898: \u5916\u9aa8\u9abc\u5fc5\u987b\u4e0e\u4eba\u4f53\u8fd0\u52a8\u5b66\u3001\u52a8\u529b\u5b66\u7279\u6027\u9ad8\u5ea6\u5339\u914d&#xff0c;\u7a7f\u6234\u8212\u9002&#xff0c;\u529b\u4f20\u9012\u8def\u5f84\u6b63\u786e&#xff0c;\u5426\u5219\u6613\u9020\u6210\u4e8c\u6b21\u4f24\u5bb3\u6216\u7528\u6237\u6392\u65a5\u3002<br \/>\n\u5bf9\u7b56: \u9700\u8981\u6df1\u5165\u7814\u7a76\u4eba\u4f53\u6b65\u6001\u751f\u7269\u529b\u5b66&#xff0c;\u8fdb\u884c\u7cbe\u5bc6\u7684\u673a\u68b0\u8bbe\u8ba1\u548c\u5927\u91cf\u7684\u4eba\u4f53\u6d4b\u8bd5\u3002<br \/>\n\u610f\u56fe\u8bc6\u522b\u7684\u51c6\u786e\u6027\u4e0e\u9c81\u68d2\u6027 (Accuracy and Robustness of Intention Recognition):<br \/>\n\u95ee\u9898: \u51c6\u786e\u3001\u5b9e\u65f6\u5730\u89e3\u8bfb\u7528\u6237\u7684\u8fd0\u52a8\u610f\u56fe\u6781\u5176\u56f0\u96be&#xff0c;\u5c24\u5176\u662f\u5728\u75c5\u7406\u72b6\u6001\u4e0b&#xff08;\u5982\u75c9\u631b\u3001\u808c\u529b\u4e0d\u5bf9\u79f0&#xff09;\u3002\u4f20\u611f\u5668\u566a\u58f0\u3001\u4e2a\u4f53\u5dee\u5f02\u90fd\u4f1a\u5f71\u54cd\u8bc6\u522b\u6548\u679c\u3002<br \/>\n\u5bf9\u7b56: \u9700\u8981\u5f00\u53d1\u9c81\u68d2\u7684\u4fe1\u53f7\u5904\u7406\u548c\u6a21\u5f0f\u8bc6\u522b\u7b97\u6cd5&#xff0c;\u53ef\u80fd\u6d89\u53ca\u673a\u5668\u5b66\u4e60\u6280\u672f&#xff0c;\u5e76\u8fdb\u884c\u5927\u91cf\u4e34\u5e8a\u6570\u636e\u8bad\u7ec3\u548c\u9a8c\u8bc1\u3002<br \/>\n\u6210\u672c\u4e0e\u666e\u53ca\u6027 (Cost and Accessibility):<br \/>\n\u95ee\u9898: \u9ad8\u6027\u80fd\u4f20\u611f\u5668\u3001BLDC\u7535\u673a\u3001\u51cf\u901f\u5668\u3001\u63a7\u5236\u7cfb\u7edf\u3001\u5b89\u5168\u8ba4\u8bc1\u7b49\u4f7f\u5f97\u7814\u53d1\u548c\u751f\u4ea7\u6210\u672c\u9ad8\u6602&#xff0c;\u9650\u5236\u4e86\u666e\u53ca\u3002<br \/>\n\u5bf9\u7b56: \u5728\u4fdd\u8bc1\u5b89\u5168\u548c\u57fa\u672c\u529f\u80fd\u7684\u524d\u63d0\u4e0b&#xff0c;\u5bfb\u6c42\u964d\u4f4e\u6210\u672c\u7684\u65b9\u6848&#xff0c;\u4f46\u8fd9\u5f80\u5f80\u4e0e\u9ad8\u6027\u80fd\u548c\u9ad8\u53ef\u9760\u6027\u76f8\u77db\u76fe\u3002<br \/>\n\u4f26\u7406\u4e0e\u6cd5\u5f8b\u8003\u91cf (Ethical and Legal Considerations):<br \/>\n\u95ee\u9898: \u6d89\u53ca\u4eba\u4f53\u4f7f\u7528\u7684\u8bbe\u5907&#xff0c;\u4f26\u7406\u5ba1\u67e5\u3001\u7528\u6237\u9690\u79c1\u4fdd\u62a4\u3001\u8d23\u4efb\u5f52\u5c5e\u7b49\u95ee\u9898\u590d\u6742\u3002<br \/>\n\u5bf9\u7b56: \u5fc5\u987b\u9075\u5b88\u76f8\u5173\u6cd5\u5f8b\u6cd5\u89c4&#xff0c;\u8fdb\u884c\u4f26\u7406\u5ba1\u67e5&#xff0c;\u660e\u786e\u4f7f\u7528\u89c4\u8303\u548c\u8d23\u4efb\u754c\u5b9a\u3002<br \/>\n\u5eb7\u590d\u6548\u679c\u7684\u79d1\u5b66\u9a8c\u8bc1 (Scientific Validation of Rehabilitation Efficacy):<br \/>\n\u95ee\u9898: \u5fc5\u987b\u901a\u8fc7\u4e25\u8c28\u7684\u4e34\u5e8a\u8bd5\u9a8c\u6765\u8bc1\u660e\u5176\u76f8\u5bf9\u4e8e\u4f20\u7edf\u5eb7\u590d\u65b9\u6cd5\u7684\u4f18\u52bf\u3002<br \/>\n\u5bf9\u7b56: \u4e0e\u533b\u7597\u673a\u6784\u5408\u4f5c\u5f00\u5c55\u4e34\u5e8a\u7814\u7a76\u3002<\/p>\n<p><img decoding=\"async\" src=\"https:\/\/www.wsisp.com\/helps\/wp-content\/uploads\/2026\/01\/20260120122620-696f746c180bb.jpg\" alt=\"\u5728\u8fd9\u91cc\u63d2\u5165\u56fe\u7247\u63cf\u8ff0\" \/><br \/>\n1\u3001\u57fa\u4e8e\u808c\u7535&#xff08;EMG&#xff09;\u7684\u4e0b\u80a2\u52a9\u884c\u5916\u9aa8\u9abc&#xff08;\u5165\u95e8\u7ea7&#xff09;<br \/>\n\u529f\u80fd&#xff1a;\u901a\u8fc7\u8868\u9762\u808c\u7535\u4f20\u611f\u5668\u91c7\u96c6\u817f\u90e8\u808c\u8089\u4fe1\u53f7&#xff0c;\u8bc6\u522b\u7528\u6237\u7684\u8fd0\u52a8\u610f\u56fe&#xff08;\u5982\u62ac\u817f\u3001\u8fc8\u6b65&#xff09;&#xff0c;\u63a7\u5236BLDC\u7535\u673a\u9a71\u52a8\u9acb\u5173\u8282\/\u819d\u5173\u8282\u8f6c\u52a8&#xff0c;\u8f85\u52a9\u884c\u8d70\u3002<br \/>\n\u786c\u4ef6&#xff1a;Arduino UNO\u3001BLDC\u7535\u673a&#xff08;\u5e26\u970d\u5c14\u4f20\u611f\u5668&#xff09;\u3001L298N\u9a71\u52a8\u5668\u30014\u4e2aEMG\u4f20\u611f\u5668&#xff08;\u5927\u817f\u524d\u4fa7\/\u540e\u4fa7\u54042\u4e2a&#xff09;\u3001IMU&#xff08;MPU6050&#xff0c;\u6d4b\u59ff\u6001&#xff09;\u3002<br \/>\n\u4ee3\u7801\u903b\u8f91&#xff1a;<br \/>\nEMG\u4fe1\u53f7\u5904\u7406&#xff1a;\u6ee4\u6ce2&#xff08;\u53bb\u9664\u5de5\u9891\u5e72\u6270&#xff09;\u3001\u5f52\u4e00\u5316&#xff08;\u6d88\u9664\u4e2a\u4f53\u5dee\u5f02&#xff09;\u3001\u7279\u5f81\u63d0\u53d6&#xff08;\u5747\u65b9\u6839\u503cRMS&#xff09;\u3002<br \/>\n\u610f\u56fe\u8bc6\u522b&#xff1a;\u7528\u9608\u503c\u6cd5\u5224\u65ad\u7528\u6237\u662f\u5426\u8981\u62ac\u817f&#xff08;\u5982RMS\u8d85\u8fc7\u9608\u503c\u2192\u62ac\u817f\u610f\u56fe&#xff09;\u3002<br \/>\nPID\u95ed\u73af\u63a7\u5236&#xff1a;\u6839\u636eIMU\u7684\u59ff\u6001\u6570\u636e\u8c03\u6574\u7535\u673a\u89d2\u5ea6&#xff0c;\u4fdd\u6301\u5173\u8282\u4e0e\u817f\u90e8\u540c\u6b65\u3002<\/p>\n<p><span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;Wire.h&gt;<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;Adafruit_MPU6050.h&gt;<\/span> <span class=\"token comment\">\/\/ IMU\u5e93<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;Acs712.h&gt;<\/span>           <span class=\"token comment\">\/\/ EMG\u4f20\u611f\u5668\u5e93&#xff08;\u7535\u6d41\u578b&#xff0c;\u9700\u8f6c\u6362\u4e3a\u7535\u538b&#xff09;<\/span><\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u786c\u4ef6\u5f15\u811a\u5b9a\u4e49<\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">define<\/span> <span class=\"token macro-name\">HALL_A<\/span> <span class=\"token expression\">D2<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">define<\/span> <span class=\"token macro-name\">HALL_B<\/span> <span class=\"token expression\">D3<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">define<\/span> <span class=\"token macro-name\">MOTOR_EN<\/span> <span class=\"token expression\">A1<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">define<\/span> <span class=\"token macro-name\">EMG_PIN<\/span> <span class=\"token expression\">A0<\/span><\/span><br \/>\nAcs712 <span class=\"token function\">emg<\/span><span class=\"token punctuation\">(<\/span>ACS712_20A<span class=\"token punctuation\">,<\/span> EMG_PIN<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ 20A EMG\u4f20\u611f\u5668&#xff08;\u68c0\u6d4b\u808c\u8089\u7535\u6d41&#xff09;<\/span><br \/>\nAdafruit_MPU6050 mpu<span class=\"token punctuation\">;<\/span>             <span class=\"token comment\">\/\/ IMU&#xff08;\u6d4b\u5927\u817f\u59ff\u6001&#xff09;<\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u5168\u5c40\u53d8\u91cf<\/span><br \/>\n<span class=\"token keyword\">float<\/span> targetAngle <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span>    <span class=\"token comment\">\/\/ \u76ee\u6807\u5173\u8282\u89d2\u5ea6&#xff08;\u5ea6&#xff09;<\/span><br \/>\n<span class=\"token keyword\">float<\/span> currentAngle <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span>   <span class=\"token comment\">\/\/ \u5f53\u524d\u5173\u8282\u89d2\u5ea6&#xff08;\u970d\u5c14\u8ba1\u6570\u8f6c\u6362&#xff09;<\/span><br \/>\n<span class=\"token keyword\">int<\/span> lastStepTime <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span>     <span class=\"token comment\">\/\/ \u4e0a\u4e00\u6b21\u62ac\u817f\u65f6\u95f4<\/span><br \/>\n<span class=\"token keyword\">bool<\/span> stepIntent <span class=\"token operator\">&#061;<\/span> <span class=\"token boolean\">false<\/span><span class=\"token punctuation\">;<\/span>  <span class=\"token comment\">\/\/ \u62ac\u817f\u610f\u56fe\u6807\u5fd7<\/span><\/p>\n<p><span class=\"token keyword\">void<\/span> <span class=\"token function\">setup<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  Serial<span class=\"token punctuation\">.<\/span><span class=\"token function\">begin<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">9600<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">pinMode<\/span><span class=\"token punctuation\">(<\/span>HALL_A<span class=\"token punctuation\">,<\/span> INPUT<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">pinMode<\/span><span class=\"token punctuation\">(<\/span>HALL_B<span class=\"token punctuation\">,<\/span> INPUT<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">pinMode<\/span><span class=\"token punctuation\">(<\/span>MOTOR_EN<span class=\"token punctuation\">,<\/span> OUTPUT<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">attachInterrupt<\/span><span class=\"token punctuation\">(<\/span><span class=\"token function\">digitalPinToInterrupt<\/span><span class=\"token punctuation\">(<\/span>HALL_A<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">,<\/span> hallUpdate<span class=\"token punctuation\">,<\/span> CHANGE<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  mpu<span class=\"token punctuation\">.<\/span><span class=\"token function\">begin<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u521d\u59cb\u5316IMU<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token keyword\">void<\/span> <span class=\"token function\">loop<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  <span class=\"token comment\">\/\/ 1. \u8bfb\u53d6EMG\u4fe1\u53f7&#xff08;\u808c\u8089\u7535\u6d41&#xff09;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> emgVoltage <span class=\"token operator\">&#061;<\/span> emg<span class=\"token punctuation\">.<\/span><span class=\"token function\">getVoltage<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u8f6c\u6362\u4e3a\u7535\u538b&#xff08;0-5V&#xff09;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> emgRMS <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">calculateRMS<\/span><span class=\"token punctuation\">(<\/span>emgVoltage<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u8ba1\u7b97\u5747\u65b9\u6839\u503c&#xff08;\u7279\u5f81&#xff09;<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 2. \u610f\u56fe\u8bc6\u522b&#xff08;\u9608\u503c\u6cd5&#xff1a;RMS&gt;0.8V\u2192\u62ac\u817f\u610f\u56fe&#xff09;<\/span><br \/>\n  <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>emgRMS <span class=\"token operator\">&gt;<\/span> <span class=\"token number\">0.8<\/span> <span class=\"token operator\">&amp;&amp;<\/span> <span class=\"token function\">millis<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#8211;<\/span> lastStepTime <span class=\"token operator\">&gt;<\/span> <span class=\"token number\">1000<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span> <span class=\"token comment\">\/\/ \u907f\u514d\u8fde\u7eed\u89e6\u53d1<\/span><br \/>\n    stepIntent <span class=\"token operator\">&#061;<\/span> <span class=\"token boolean\">true<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    lastStepTime <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">millis<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span> <span class=\"token keyword\">else<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    stepIntent <span class=\"token operator\">&#061;<\/span> <span class=\"token boolean\">false<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 3. \u59ff\u6001\u77eb\u6b63&#xff08;IMU\u83b7\u53d6\u5927\u817f\u89d2\u5ea6&#xff0c;\u8c03\u6574\u76ee\u6807\u89d2\u5ea6&#xff09;<\/span><br \/>\n  sensors_event_t a<span class=\"token punctuation\">,<\/span> g<span class=\"token punctuation\">,<\/span> temp<span class=\"token punctuation\">;<\/span><br \/>\n  mpu<span class=\"token punctuation\">.<\/span><span class=\"token function\">getEvent<\/span><span class=\"token punctuation\">(<\/span><span class=\"token operator\">&amp;<\/span>a<span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&amp;<\/span>g<span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&amp;<\/span>temp<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> thighAngle <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">atan2<\/span><span class=\"token punctuation\">(<\/span>a<span class=\"token punctuation\">.<\/span>acceleration<span class=\"token punctuation\">.<\/span>y<span class=\"token punctuation\">,<\/span> a<span class=\"token punctuation\">.<\/span>acceleration<span class=\"token punctuation\">.<\/span>z<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">*<\/span> <span class=\"token number\">180<\/span> <span class=\"token operator\">\/<\/span> PI<span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u5927\u817f\u4fef\u4ef0\u89d2<\/span><br \/>\n  targetAngle <span class=\"token operator\">&#061;<\/span> thighAngle <span class=\"token operator\">&#043;<\/span> <span class=\"token number\">15<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u76ee\u6807\u89d2\u5ea6&#061;\u5927\u817f\u89d2\u5ea6&#043;15\u00b0&#xff08;\u8f85\u52a9\u62ac\u817f&#xff09;<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 4. PID\u63a7\u5236\u7535\u673a&#xff08;\u4fdd\u6301\u5173\u8282\u89d2\u5ea6\u8ddf\u8e2a&#xff09;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> error <span class=\"token operator\">&#061;<\/span> targetAngle <span class=\"token operator\">&#8211;<\/span> currentAngle<span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">static<\/span> <span class=\"token keyword\">float<\/span> integral <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> lastError <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> derivative <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">(<\/span>error <span class=\"token operator\">&#8211;<\/span> lastError<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">\/<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u91c7\u6837\u5468\u671f0.1s<\/span><br \/>\n  integral <span class=\"token operator\">&#043;&#061;<\/span> error <span class=\"token operator\">*<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ PID\u53c2\u6570&#xff08;\u7ecf\u9a8c\u8c03\u53c2&#xff09;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> kp <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">2.0<\/span><span class=\"token punctuation\">,<\/span> ki <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">,<\/span> kd <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.5<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> output <span class=\"token operator\">&#061;<\/span> kp <span class=\"token operator\">*<\/span> error <span class=\"token operator\">&#043;<\/span> ki <span class=\"token operator\">*<\/span> integral <span class=\"token operator\">&#043;<\/span> kd <span class=\"token operator\">*<\/span> derivative<span class=\"token punctuation\">;<\/span><br \/>\n  output <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">constrain<\/span><span class=\"token punctuation\">(<\/span>output<span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">255<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">255<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u9650\u5236\u8f93\u51fa\u8303\u56f4<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 5. \u63a7\u5236\u7535\u673a\u8f6c\u5411\u4e0e\u8f6c\u901f<\/span><br \/>\n  <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>stepIntent<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    <span class=\"token function\">digitalWrite<\/span><span class=\"token punctuation\">(<\/span>MOTOR_EN<span class=\"token punctuation\">,<\/span> HIGH<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token function\">analogWrite<\/span><span class=\"token punctuation\">(<\/span>MOTOR_EN<span class=\"token punctuation\">,<\/span> <span class=\"token function\">abs<\/span><span class=\"token punctuation\">(<\/span>output<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token comment\">\/\/ \u6839\u636e\u8bef\u5dee\u65b9\u5411\u8c03\u6574\u8f6c\u5411<\/span><br \/>\n    <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>output <span class=\"token operator\">&gt;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token function\">digitalWrite<\/span><span class=\"token punctuation\">(<\/span>HALL_A<span class=\"token punctuation\">,<\/span> HIGH<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u6b63\u8f6c&#xff08;\u62ac\u817f&#xff09;<\/span><br \/>\n    <span class=\"token keyword\">else<\/span> <span class=\"token function\">digitalWrite<\/span><span class=\"token punctuation\">(<\/span>HALL_A<span class=\"token punctuation\">,<\/span> LOW<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u53cd\u8f6c&#xff08;\u653e\u4e0b&#xff09;<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span> <span class=\"token keyword\">else<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    <span class=\"token function\">digitalWrite<\/span><span class=\"token punctuation\">(<\/span>MOTOR_EN<span class=\"token punctuation\">,<\/span> LOW<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u505c\u6b62<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span><\/p>\n<p>  lastError <span class=\"token operator\">&#061;<\/span> error<span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">delay<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">100<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u8ba1\u7b97RMS&#xff08;\u5747\u65b9\u6839\u503c&#xff0c;EMG\u7279\u5f81&#xff09;<\/span><br \/>\n<span class=\"token keyword\">float<\/span> <span class=\"token function\">calculateRMS<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">float<\/span> voltage<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  <span class=\"token keyword\">static<\/span> <span class=\"token keyword\">float<\/span> sum <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> count <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  sum <span class=\"token operator\">&#043;&#061;<\/span> voltage <span class=\"token operator\">*<\/span> voltage<span class=\"token punctuation\">;<\/span><br \/>\n  count<span class=\"token operator\">&#043;&#043;<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>count <span class=\"token operator\">&gt;&#061;<\/span> <span class=\"token number\">10<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span> <span class=\"token comment\">\/\/ \u53d610\u4e2a\u6837\u672c\u7684\u5e73\u5747<\/span><br \/>\n    <span class=\"token keyword\">float<\/span> rms <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">sqrt<\/span><span class=\"token punctuation\">(<\/span>sum <span class=\"token operator\">\/<\/span> count<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    sum <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> count <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">return<\/span> rms<span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span><br \/>\n  <span class=\"token keyword\">return<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u970d\u5c14\u4f20\u611f\u5668\u4e2d\u65ad&#xff1a;\u66f4\u65b0\u5f53\u524d\u5173\u8282\u89d2\u5ea6<\/span><br \/>\n<span class=\"token keyword\">void<\/span> <span class=\"token function\">hallUpdate<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  currentAngle <span class=\"token operator\">&#043;&#061;<\/span> <span class=\"token number\">1<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u6bcf\u8109\u51b2\u589e\u52a01\u00b0&#xff08;\u9700\u6821\u51c6\u970d\u5c14\u5206\u8fa8\u7387&#xff09;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p>2\u3001\u57fa\u4e8e\u538b\u529b\u4e2d\u5fc3\u7684\u5e73\u8861\u8f85\u52a9\u5916\u9aa8\u9abc&#xff08;\u8fdb\u9636\u7ea7&#xff09;<br \/>\n\u529f\u80fd&#xff1a;\u901a\u8fc7\u8db3\u5e95\u538b\u529b\u4f20\u611f\u5668\u68c0\u6d4b\u91cd\u5fc3\u4f4d\u7f6e&#xff08;COP&#xff09;&#xff0c;\u7ed3\u5408IMU\u7684\u59ff\u6001\u6570\u636e&#xff0c;\u63a7\u5236BLDC\u7535\u673a\u8c03\u6574\u9acb\u5173\u8282\u529b\u77e9&#xff0c;\u9632\u6b62\u7528\u6237\u6454\u5012&#xff08;\u5982\u91cd\u5fc3\u504f\u79fb\u65f6\u53cd\u5411\u65bd\u529b&#xff09;\u3002<br \/>\n\u786c\u4ef6&#xff1a;Arduino Mega\u3001BLDC\u7535\u673a&#xff08;\u5e26\u7f16\u7801\u5668&#xff09;\u3001TB6560\u9a71\u52a8\u5668\u30014\u4e2a\u538b\u529b\u4f20\u611f\u5668&#xff08;\u8db3\u5e95\u524d\u638c\/\u540e\u8ddf\u54042\u4e2a&#xff09;\u3001IMU&#xff08;MPU9250&#xff09;\u3002<br \/>\n\u4ee3\u7801\u903b\u8f91&#xff1a;<br \/>\n\u538b\u529b\u6570\u636e\u5904\u7406&#xff1a;\u8ba1\u7b97\u91cd\u5fc3\u5750\u6807&#xff08;x&#061;(\u5de6\u524d&#043;\u53f3\u524d)-(\u5de6\u540e&#043;\u53f3\u540e)&#xff0c;y&#061;(\u524d\u638c\u603b\u548c)-(\u540e\u8ddf\u603b\u548c)&#xff09;\u3002<br \/>\n\u5e73\u8861\u63a7\u5236&#xff1a;\u7528\u6a21\u7cca\u903b\u8f91\u8c03\u6574\u7535\u673a\u529b\u77e9&#xff08;\u5982\u91cd\u5fc3\u5de6\u504f\u2192\u53f3\u9acb\u5173\u8282\u589e\u5927\u529b\u77e9&#xff0c;\u62c9\u56de\u91cd\u5fc3&#xff09;\u3002<br \/>\n\u529b\u77e9\u95ed\u73af&#xff1a;\u901a\u8fc7\u7f16\u7801\u5668\u7684\u8f6c\u901f\u53cd\u9988&#xff0c;\u4fdd\u6301\u529b\u77e9\u7a33\u5b9a&#xff08;\u907f\u514d\u8fc7\u51b2&#xff09;\u3002<\/p>\n<p><span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;Fuzzy.h&gt;<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;Encoder.h&gt;<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;Adafruit_MPU9250.h&gt;<\/span><\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u786c\u4ef6\u5f15\u811a\u5b9a\u4e49<\/span><br \/>\nEncoder <span class=\"token function\">encoder<\/span><span class=\"token punctuation\">(<\/span>D2<span class=\"token punctuation\">,<\/span> D3<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u7f16\u7801\u5668&#xff08;\u6d4b\u7535\u673a\u8f6c\u901f&#xff09;<\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">define<\/span> <span class=\"token macro-name\">PRESSURE_LEFT_FRONT<\/span> <span class=\"token expression\">A0<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">define<\/span> <span class=\"token macro-name\">PRESSURE_LEFT_REAR<\/span> <span class=\"token expression\">A1<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">define<\/span> <span class=\"token macro-name\">PRESSURE_RIGHT_FRONT<\/span> <span class=\"token expression\">A2<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">define<\/span> <span class=\"token macro-name\">PRESSURE_RIGHT_REAR<\/span> <span class=\"token expression\">A3<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">define<\/span> <span class=\"token macro-name\">MOTOR_DIR<\/span> <span class=\"token expression\">D9<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">define<\/span> <span class=\"token macro-name\">MOTOR_PWM<\/span> <span class=\"token expression\">D10<\/span><\/span><br \/>\nAdafruit_MPU9250 mpu<span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ IMU&#xff08;\u6d4b\u8eaf\u5e72\u59ff\u6001&#xff09;<\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u5168\u5c40\u53d8\u91cf<\/span><br \/>\n<span class=\"token keyword\">float<\/span> copX <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> copY <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u91cd\u5fc3\u5750\u6807<\/span><br \/>\n<span class=\"token keyword\">float<\/span> torqueTarget <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span>   <span class=\"token comment\">\/\/ \u76ee\u6807\u529b\u77e9&#xff08;N\u00b7m&#xff09;<\/span><br \/>\n<span class=\"token keyword\">float<\/span> currentTorque <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span>  <span class=\"token comment\">\/\/ \u5f53\u524d\u529b\u77e9&#xff08;\u7f16\u7801\u5668\u8f6c\u901f\u8f6c\u6362&#xff09;<\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u6a21\u7cca\u63a7\u5236\u5668\u521d\u59cb\u5316<\/span><br \/>\nFuzzy<span class=\"token operator\">*<\/span> fuzzyTorque<span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token keyword\">void<\/span> <span class=\"token function\">setup<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  Serial<span class=\"token punctuation\">.<\/span><span class=\"token function\">begin<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">9600<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">pinMode<\/span><span class=\"token punctuation\">(<\/span>PRESSURE_LEFT_FRONT<span class=\"token punctuation\">,<\/span> INPUT<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">pinMode<\/span><span class=\"token punctuation\">(<\/span>PRESSURE_LEFT_REAR<span class=\"token punctuation\">,<\/span> INPUT<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">pinMode<\/span><span class=\"token punctuation\">(<\/span>PRESSURE_RIGHT_FRONT<span class=\"token punctuation\">,<\/span> INPUT<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">pinMode<\/span><span class=\"token punctuation\">(<\/span>PRESSURE_RIGHT_REAR<span class=\"token punctuation\">,<\/span> INPUT<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">pinMode<\/span><span class=\"token punctuation\">(<\/span>MOTOR_DIR<span class=\"token punctuation\">,<\/span> OUTPUT<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">pinMode<\/span><span class=\"token punctuation\">(<\/span>MOTOR_PWM<span class=\"token punctuation\">,<\/span> OUTPUT<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  fuzzyTorque <span class=\"token operator\">&#061;<\/span> <span class=\"token keyword\">new<\/span> <span class=\"token function\">Fuzzy<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">2<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">1<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u8f93\u5165&#xff1a;copX\u504f\u5dee\u3001copY\u504f\u5dee&#xff1b;\u8f93\u51fa&#xff1a;\u529b\u77e9<\/span><br \/>\n  <span class=\"token function\">defineTorqueFuzzySets<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">defineTorqueRules<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token keyword\">void<\/span> <span class=\"token function\">loop<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  <span class=\"token comment\">\/\/ 1. \u8bfb\u53d6\u538b\u529b\u4f20\u611f\u5668\u6570\u636e&#xff08;\u6a21\u62df\u91cf&#xff0c;0-1023\u5bf9\u5e940-50kg&#xff09;<\/span><br \/>\n  <span class=\"token keyword\">int<\/span> leftFront <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">analogRead<\/span><span class=\"token punctuation\">(<\/span>PRESSURE_LEFT_FRONT<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">int<\/span> leftRear <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">analogRead<\/span><span class=\"token punctuation\">(<\/span>PRESSURE_LEFT_REAR<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">int<\/span> rightFront <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">analogRead<\/span><span class=\"token punctuation\">(<\/span>PRESSURE_RIGHT_FRONT<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">int<\/span> rightRear <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">analogRead<\/span><span class=\"token punctuation\">(<\/span>PRESSURE_RIGHT_REAR<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 2. \u8ba1\u7b97\u91cd\u5fc3\u5750\u6807&#xff08;\u5f52\u4e00\u5316\u5230-1~1&#xff09;<\/span><br \/>\n  copX <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">map<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">(<\/span>leftFront <span class=\"token operator\">&#043;<\/span> rightFront<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#8211;<\/span> <span class=\"token punctuation\">(<\/span>leftRear <span class=\"token operator\">&#043;<\/span> rightRear<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">2046<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">2046<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">1<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  copY <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">map<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">(<\/span>leftFront <span class=\"token operator\">&#043;<\/span> rightFront <span class=\"token operator\">&#043;<\/span> leftRear <span class=\"token operator\">&#043;<\/span> rightRear<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">\/<\/span> <span class=\"token number\">2<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">1023<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">1<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 3. \u6a21\u7cca\u63a8\u7406&#xff1a;\u83b7\u53d6\u76ee\u6807\u529b\u77e9&#xff08;-5~5 N\u00b7m&#xff09;<\/span><br \/>\n  fuzzyTorque<span class=\"token operator\">-&gt;<\/span><span class=\"token function\">setInput<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> copX<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  fuzzyTorque<span class=\"token operator\">-&gt;<\/span><span class=\"token function\">setInput<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">,<\/span> copY<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  fuzzyTorque<span class=\"token operator\">-&gt;<\/span><span class=\"token function\">fuzzify<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  torqueTarget <span class=\"token operator\">&#061;<\/span> fuzzyTorque<span class=\"token operator\">-&gt;<\/span><span class=\"token function\">getOutput<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 4. \u529b\u77e9\u95ed\u73af\u63a7\u5236&#xff08;\u7f16\u7801\u5668\u8f6c\u901f\u2192\u529b\u77e9&#xff09;<\/span><br \/>\n  <span class=\"token keyword\">long<\/span> currentSpeed <span class=\"token operator\">&#061;<\/span> encoder<span class=\"token punctuation\">.<\/span><span class=\"token function\">read<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u7f16\u7801\u5668\u8109\u51b2\u6570&#xff08;\u8f6c\u901f&#xff09;<\/span><br \/>\n  encoder<span class=\"token punctuation\">.<\/span><span class=\"token function\">write<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u6e05\u96f6<\/span><br \/>\n  currentTorque <span class=\"token operator\">&#061;<\/span> currentSpeed <span class=\"token operator\">*<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u8f6c\u6362\u7cfb\u6570&#xff08;\u5047\u8bbe1\u8109\u51b2&#061;0.1N\u00b7m&#xff09;<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 5. PID\u8c03\u6574PWM&#xff08;\u8ddf\u8e2a\u76ee\u6807\u529b\u77e9&#xff09;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> error <span class=\"token operator\">&#061;<\/span> torqueTarget <span class=\"token operator\">&#8211;<\/span> currentTorque<span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">static<\/span> <span class=\"token keyword\">float<\/span> integral <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> lastError <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> derivative <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">(<\/span>error <span class=\"token operator\">&#8211;<\/span> lastError<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">\/<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  integral <span class=\"token operator\">&#043;&#061;<\/span> error <span class=\"token operator\">*<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  <span class=\"token keyword\">float<\/span> kp <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">1.5<\/span><span class=\"token punctuation\">,<\/span> ki <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.05<\/span><span class=\"token punctuation\">,<\/span> kd <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.2<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> pwmValue <span class=\"token operator\">&#061;<\/span> kp <span class=\"token operator\">*<\/span> error <span class=\"token operator\">&#043;<\/span> ki <span class=\"token operator\">*<\/span> integral <span class=\"token operator\">&#043;<\/span> kd <span class=\"token operator\">*<\/span> derivative<span class=\"token punctuation\">;<\/span><br \/>\n  pwmValue <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">constrain<\/span><span class=\"token punctuation\">(<\/span>pwmValue<span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">255<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 6. \u63a7\u5236\u7535\u673a\u8f6c\u5411&#xff08;\u529b\u77e9\u65b9\u5411&#xff09;<\/span><br \/>\n  <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>torqueTarget <span class=\"token operator\">&gt;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token function\">digitalWrite<\/span><span class=\"token punctuation\">(<\/span>MOTOR_DIR<span class=\"token punctuation\">,<\/span> HIGH<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u6b63\u8f6c&#xff08;\u7ea0\u6b63\u91cd\u5fc3&#xff09;<\/span><br \/>\n  <span class=\"token keyword\">else<\/span> <span class=\"token function\">digitalWrite<\/span><span class=\"token punctuation\">(<\/span>MOTOR_DIR<span class=\"token punctuation\">,<\/span> LOW<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u53cd\u8f6c<\/span><\/p>\n<p>  <span class=\"token function\">analogWrite<\/span><span class=\"token punctuation\">(<\/span>MOTOR_PWM<span class=\"token punctuation\">,<\/span> pwmValue<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  lastError <span class=\"token operator\">&#061;<\/span> error<span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">delay<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">10<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u9ad8\u9891\u91c7\u6837&#xff08;\u529b\u77e9\u63a7\u5236\u9700\u5feb\u901f\u54cd\u5e94&#xff09;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u5b9a\u4e49\u529b\u77e9\u7684\u6a21\u7cca\u96c6&#xff08;\u8f93\u5165copX\/Y&#xff1a;-1~1&#xff1b;\u8f93\u51fa\u529b\u77e9&#xff1a;-5~5&#xff09;<\/span><br \/>\n<span class=\"token keyword\">void<\/span> <span class=\"token function\">defineTorqueFuzzySets<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  fuzzyTorque<span class=\"token operator\">-&gt;<\/span><span class=\"token function\">addInputSet<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">new<\/span> <span class=\"token function\">Triangular<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;Left&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">0.5<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span>   <span class=\"token comment\">\/\/ \u91cd\u5fc3\u5de6\u504f<\/span><br \/>\n  fuzzyTorque<span class=\"token operator\">-&gt;<\/span><span class=\"token function\">addInputSet<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">new<\/span> <span class=\"token function\">Triangular<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;Center&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">0.5<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.5<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><span class=\"token comment\">\/\/ \u91cd\u5fc3\u4e2d<\/span><br \/>\n  fuzzyTorque<span class=\"token operator\">-&gt;<\/span><span class=\"token function\">addInputSet<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">new<\/span> <span class=\"token function\">Triangular<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;Right&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.5<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">1<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span>    <span class=\"token comment\">\/\/ \u91cd\u5fc3\u53f3\u504f<\/span><\/p>\n<p>  fuzzyTorque<span class=\"token operator\">-&gt;<\/span><span class=\"token function\">addOutputSet<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">new<\/span> <span class=\"token function\">Triangular<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;Negative&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">5<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">2.5<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><span class=\"token comment\">\/\/ \u8d1f\u529b\u77e9&#xff08;\u5de6\u504f\u65f6\u53f3\u62c9&#xff09;<\/span><br \/>\n  fuzzyTorque<span class=\"token operator\">-&gt;<\/span><span class=\"token function\">addOutputSet<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">new<\/span> <span class=\"token function\">Triangular<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;Zero&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">1<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span>       <span class=\"token comment\">\/\/ \u96f6\u529b\u77e9&#xff08;\u5e73\u8861&#xff09;<\/span><br \/>\n  fuzzyTorque<span class=\"token operator\">-&gt;<\/span><span class=\"token function\">addOutputSet<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">new<\/span> <span class=\"token function\">Triangular<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;Positive&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">2.5<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">5<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span>  <span class=\"token comment\">\/\/ \u6b63\u529b\u77e9&#xff08;\u53f3\u504f\u65f6\u5de6\u62c9&#xff09;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u5b9a\u4e49\u529b\u77e9\u7684\u6a21\u7cca\u89c4\u5219<\/span><br \/>\n<span class=\"token keyword\">void<\/span> <span class=\"token function\">defineTorqueRules<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  fuzzyTorque<span class=\"token operator\">-&gt;<\/span><span class=\"token function\">addRule<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">new<\/span> <span class=\"token function\">FuzzyRule<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;Left&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token string\">&#034;Center&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token string\">&#034;Negative&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u5de6\u504f\u2192\u8d1f\u529b\u77e9<\/span><br \/>\n  fuzzyTorque<span class=\"token operator\">-&gt;<\/span><span class=\"token function\">addRule<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">new<\/span> <span class=\"token function\">FuzzyRule<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;Right&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token string\">&#034;Center&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token string\">&#034;Positive&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><span class=\"token comment\">\/\/ \u53f3\u504f\u2192\u6b63\u529b\u77e9<\/span><br \/>\n  fuzzyTorque<span class=\"token operator\">-&gt;<\/span><span class=\"token function\">addRule<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">new<\/span> <span class=\"token function\">FuzzyRule<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;Center&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token string\">&#034;Center&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token string\">&#034;Zero&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span>    <span class=\"token comment\">\/\/ \u4e2d\u2192\u96f6\u529b\u77e9<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p>3\u3001\u57fa\u4e8e\u591a\u6a21\u6001\u878d\u5408\u7684\u667a\u80fd\u52a9\u884c\u5916\u9aa8\u9abc&#xff08;\u9ad8\u7ea7\u7ea7&#xff09;<br \/>\n\u529f\u80fd&#xff1a;\u6574\u5408EMG&#xff08;\u610f\u56fe&#xff09;\u3001\u538b\u529b&#xff08;\u91cd\u5fc3&#xff09;\u3001IMU&#xff08;\u59ff\u6001&#xff09;\u4e09\u7c7b\u4f20\u611f\u5668\u6570\u636e&#xff0c;\u7528\u5361\u5c14\u66fc\u6ee4\u6ce2\u878d\u5408\u4fe1\u606f&#xff0c;\u5b9e\u73b0\u66f4\u7cbe\u51c6\u7684\u610f\u56fe\u8bc6\u522b\u4e0e\u81ea\u9002\u5e94\u52a9\u529b&#xff08;\u5982\u4e0a\u4e0b\u5761\u65f6\u81ea\u52a8\u8c03\u6574\u529b\u77e9&#xff09;\u3002<br \/>\n\u786c\u4ef6&#xff1a;Arduino Mega\u3001BLDC\u7535\u673a&#xff08;\u5e26\u7edd\u5bf9\u503c\u7f16\u7801\u5668&#xff09;\u3001\u4f3a\u670d\u9a71\u52a8\u5668\u3001\u591a\u6a21\u6001\u4f20\u611f\u5668\u6a21\u5757&#xff08;\u96c6\u6210EMG&#043;\u538b\u529b&#043;IMU&#xff09;\u3001Wi-Fi\u6a21\u5757&#xff08;ESP8266&#xff0c;\u4e0a\u4f20\u6570\u636e\u5230\u4e91\u7aef&#xff09;\u3002<br \/>\n\u4ee3\u7801\u903b\u8f91&#xff1a;<br \/>\n\u591a\u6e90\u6570\u636e\u91c7\u96c6&#xff1a;\u540c\u65f6\u8bfb\u53d6EMG\u3001\u538b\u529b\u3001IMU\u6570\u636e\u3002<br \/>\n\u6570\u636e\u878d\u5408&#xff1a;\u7528\u5361\u5c14\u66fc\u6ee4\u6ce2\u4f30\u8ba1\u7528\u6237\u7684\u8fd0\u52a8\u72b6\u6001&#xff08;\u5982\u6b65\u884c\u3001\u4e0a\u697c\u3001\u4e0b\u697c&#xff09;\u3002<br \/>\n\u81ea\u9002\u5e94\u63a7\u5236&#xff1a;\u6839\u636e\u8fd0\u52a8\u72b6\u6001\u8c03\u6574BLDC\u7535\u673a\u7684\u52a9\u529b\u6a21\u5f0f&#xff08;\u5982\u4e0a\u697c\u65f6\u589e\u5927\u9acb\u5173\u8282\u529b\u77e9&#xff0c;\u4e0b\u697c\u65f6\u51cf\u5c0f\u529b\u77e9\u5e76\u5236\u52a8&#xff09;\u3002<\/p>\n<p><span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;KalmanFilter.h&gt;<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;ESP8266WiFi.h&gt;<\/span> <span class=\"token comment\">\/\/ Wi-Fi\u5e93&#xff08;\u4e0a\u4f20\u6570\u636e\u5230\u4e91\u7aef&#xff09;<\/span><\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u786c\u4ef6\u5b9a\u4e49&#xff08;\u7b80\u5316&#xff09;<\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">define<\/span> <span class=\"token macro-name\">EMG_PIN<\/span> <span class=\"token expression\">A0<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">define<\/span> <span class=\"token macro-name\">PRESSURE_PIN<\/span> <span class=\"token expression\">A1<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">define<\/span> <span class=\"token macro-name\">IMU_PIN<\/span> <span class=\"token expression\">A2<\/span><\/span><br \/>\nKalmanFilter kf<span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u5361\u5c14\u66fc\u6ee4\u6ce2\u5bf9\u8c61&#xff08;\u878d\u54083\u7c7b\u6570\u636e&#xff09;<\/span><br \/>\nWiFiClient wifiClient<span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ Wi-Fi\u5ba2\u6237\u7aef<\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u5168\u5c40\u53d8\u91cf<\/span><br \/>\n<span class=\"token keyword\">float<\/span> emgSignal <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> pressureSignal <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> imuSignal <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token keyword\">float<\/span> fusedState <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u878d\u5408\u540e\u7684\u8fd0\u52a8\u72b6\u6001&#xff08;0&#061;\u9759\u6b62&#xff0c;1&#061;\u6b65\u884c&#xff0c;2&#061;\u4e0a\u697c&#xff0c;3&#061;\u4e0b\u697c&#xff09;<\/span><br \/>\n<span class=\"token keyword\">float<\/span> motorTorque <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u6700\u7ec8\u8f93\u51fa\u529b\u77e9<\/span><\/p>\n<p><span class=\"token keyword\">void<\/span> <span class=\"token function\">setup<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  Serial<span class=\"token punctuation\">.<\/span><span class=\"token function\">begin<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">9600<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  WiFi<span class=\"token punctuation\">.<\/span><span class=\"token function\">begin<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;SSID&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token string\">&#034;PASSWORD&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u8fde\u63a5Wi-Fi<\/span><br \/>\n  <span class=\"token keyword\">while<\/span> <span class=\"token punctuation\">(<\/span>WiFi<span class=\"token punctuation\">.<\/span><span class=\"token function\">status<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">!&#061;<\/span> WL_CONNECTED<span class=\"token punctuation\">)<\/span> <span class=\"token function\">delay<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">1000<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  kf<span class=\"token punctuation\">.<\/span><span class=\"token function\">init<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">3<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">2<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u72b6\u6001\u7ef4\u5ea6&#xff08;\u8fd0\u52a8\u72b6\u6001&#xff09;&#xff0c;\u89c2\u6d4b\u7ef4\u5ea6&#xff08;3\u7c7b\u4f20\u611f\u5668&#xff09;<\/span><br \/>\n  kf<span class=\"token punctuation\">.<\/span>processNoiseCov <span class=\"token operator\">&lt;&lt;<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u8fc7\u7a0b\u566a\u58f0<\/span><br \/>\n  kf<span class=\"token punctuation\">.<\/span>measurementNoiseCov <span class=\"token operator\">&lt;&lt;<\/span> <span class=\"token number\">0.01<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.01<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.01<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u89c2\u6d4b\u566a\u58f0<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token keyword\">void<\/span> <span class=\"token function\">loop<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  <span class=\"token comment\">\/\/ 1. \u91c7\u96c6\u591a\u6e90\u6570\u636e<\/span><br \/>\n  emgSignal <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">analogRead<\/span><span class=\"token punctuation\">(<\/span>EMG_PIN<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">\/<\/span> <span class=\"token number\">1023.0<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u5f52\u4e00\u5316&#xff08;0-1&#xff09;<\/span><br \/>\n  pressureSignal <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">analogRead<\/span><span class=\"token punctuation\">(<\/span>PRESSURE_PIN<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">\/<\/span> <span class=\"token number\">1023.0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  imuSignal <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">analogRead<\/span><span class=\"token punctuation\">(<\/span>IMU_PIN<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">\/<\/span> <span class=\"token number\">1023.0<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 2. \u5361\u5c14\u66fc\u6ee4\u6ce2\u878d\u5408<\/span><br \/>\n  kf<span class=\"token punctuation\">.<\/span><span class=\"token function\">predict<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u9884\u6d4b\u4e0b\u4e00\u72b6\u6001<\/span><br \/>\n  kf<span class=\"token punctuation\">.<\/span>update <span class=\"token operator\">&lt;&lt;<\/span> emgSignal<span class=\"token punctuation\">,<\/span> pressureSignal<span class=\"token punctuation\">,<\/span> imuSignal<span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u66f4\u65b0\u89c2\u6d4b\u503c<\/span><br \/>\n  fusedState <span class=\"token operator\">&#061;<\/span> kf<span class=\"token punctuation\">.<\/span>statePost<span class=\"token punctuation\">[<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u83b7\u53d6\u878d\u5408\u540e\u7684\u8fd0\u52a8\u72b6\u6001<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 3. \u81ea\u9002\u5e94\u52a9\u529b\u6a21\u5f0f\u5207\u6362<\/span><br \/>\n  <span class=\"token keyword\">switch<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">int<\/span><span class=\"token punctuation\">)<\/span>fusedState<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    <span class=\"token keyword\">case<\/span> <span class=\"token number\">0<\/span><span class=\"token operator\">:<\/span> <span class=\"token comment\">\/\/ \u9759\u6b62\u2192\u96f6\u529b\u77e9<\/span><br \/>\n      motorTorque <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n      <span class=\"token keyword\">break<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">case<\/span> <span class=\"token number\">1<\/span><span class=\"token operator\">:<\/span> <span class=\"token comment\">\/\/ \u6b65\u884c\u2192\u4e2d\u7b49\u529b\u77e9&#xff08;\u7ef4\u6301\u5e73\u8861&#xff09;<\/span><br \/>\n      motorTorque <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">3<\/span><span class=\"token punctuation\">;<\/span><br \/>\n      <span class=\"token keyword\">break<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">case<\/span> <span class=\"token number\">2<\/span><span class=\"token operator\">:<\/span> <span class=\"token comment\">\/\/ \u4e0a\u697c\u2192\u5927\u529b\u77e9&#xff08;\u8f85\u52a9\u62ac\u817f&#xff09;<\/span><br \/>\n      motorTorque <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">5<\/span><span class=\"token punctuation\">;<\/span><br \/>\n      <span class=\"token keyword\">break<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">case<\/span> <span class=\"token number\">3<\/span><span class=\"token operator\">:<\/span> <span class=\"token comment\">\/\/ \u4e0b\u697c\u2192\u5c0f\u529b\u77e9&#043;\u5236\u52a8&#xff08;\u9632\u6b62\u4e0b\u5760&#xff09;<\/span><br \/>\n      motorTorque <span class=\"token operator\">&#061;<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u8d1f\u529b\u77e9\u8868\u793a\u5236\u52a8<\/span><br \/>\n      <span class=\"token keyword\">break<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">default<\/span><span class=\"token operator\">:<\/span><br \/>\n      motorTorque <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 4. \u63a7\u5236\u7535\u673a&#xff08;\u540c\u6848\u4f8b2\u7684\u529b\u77e9\u95ed\u73af&#xff09;<\/span><br \/>\n  <span class=\"token function\">controlMotorTorque<\/span><span class=\"token punctuation\">(<\/span>motorTorque<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 5. \u4e0a\u4f20\u6570\u636e\u5230\u4e91\u7aef&#xff08;\u8fdc\u7a0b\u76d1\u63a7&#xff09;<\/span><br \/>\n  String data <span class=\"token operator\">&#061;<\/span> <span class=\"token string\">&#034;EMG:&#034;<\/span> <span class=\"token operator\">&#043;<\/span> <span class=\"token function\">String<\/span><span class=\"token punctuation\">(<\/span>emgSignal<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#043;<\/span> <span class=\"token string\">&#034;,Pressure:&#034;<\/span> <span class=\"token operator\">&#043;<\/span> <span class=\"token function\">String<\/span><span class=\"token punctuation\">(<\/span>pressureSignal<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#043;<\/span> <span class=\"token string\">&#034;,State:&#034;<\/span> <span class=\"token operator\">&#043;<\/span> <span class=\"token function\">String<\/span><span class=\"token punctuation\">(<\/span>fusedState<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  wifiClient<span class=\"token punctuation\">.<\/span><span class=\"token function\">println<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;GET \/data?&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  wifiClient<span class=\"token punctuation\">.<\/span><span class=\"token function\">println<\/span><span class=\"token punctuation\">(<\/span>data<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  wifiClient<span class=\"token punctuation\">.<\/span><span class=\"token function\">stop<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  <span class=\"token function\">delay<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">100<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u63a7\u5236\u7535\u673a\u529b\u77e9\u7684\u51fd\u6570&#xff08;\u540c\u6848\u4f8b2&#xff09;<\/span><br \/>\n<span class=\"token keyword\">void<\/span> <span class=\"token function\">controlMotorTorque<\/span><span class=\"token punctuation\">(<\/span><span class=\"token keyword\">float<\/span> torque<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  <span class=\"token comment\">\/\/ &#8230; \u590d\u5236\u6848\u4f8b2\u7684\u529b\u77e9\u95ed\u73af\u4ee3\u7801 &#8230;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p>\u8981\u70b9\u89e3\u8bfb<\/p>\n<li>\u5b89\u5168\u6027\u4f18\u5148&#xff1a;\u201c\u8f6f\u786c\u7ed3\u5408\u201d\u7684\u9632\u62a4\u673a\u5236<br \/>\n\u533b\u7597\u5916\u9aa8\u9abc\u76f4\u63a5\u63a5\u89e6\u60a3\u8005&#xff0c;\u5b89\u5168\u662f\u7b2c\u4e00\u4f18\u5148\u7ea7\u3002\u9700\u8bbe\u8ba1\u591a\u5c42\u9632\u62a4&#xff1a;<br \/>\n\u786c\u4ef6\u4fdd\u62a4&#xff1a;\u7535\u673a\u9a71\u52a8\u5668\u5185\u7f6e\u8fc7\u6d41\/\u8fc7\u538b\u4fdd\u62a4&#xff08;\u5982TB6560\u7684OC\u5173\u65ad&#xff09;&#xff1b;\u7535\u6c60\u91c7\u7528\u78f7\u9178\u94c1\u9502&#xff08;\u5b89\u5168\u7a33\u5b9a&#xff0c;\u907f\u514d\u7206\u70b8&#xff09;&#xff1b;<br \/>\n\u8f6f\u4ef6\u9650\u5236&#xff1a;\u8bbe\u7f6e\u529b\u77e9\u4e0a\u9650&#xff08;\u5982\u6848\u4f8b2\u4e2d\u00b15N\u00b7m&#xff09;\u3001\u901f\u5ea6\u4e0a\u9650&#xff08;\u5982\u6848\u4f8b1\u4e2d100rpm&#xff09;&#xff0c;\u9632\u6b62\u7535\u673a\u5931\u63a7&#xff1b;<br \/>\n\u6025\u505c\u6309\u94ae&#xff1a;\u7269\u7406\u6309\u952e\u5f3a\u5236\u5207\u65ad\u7535\u673a\u7535\u6e90&#xff08;\u4ee3\u7801\u4e2d\u53ef\u6dfb\u52a0if (digitalRead(EMERGENCY_BTN) &#061;&#061; LOW) stopMotors();&#xff09;\u3002<br \/>\n\u6848\u4f8b\u5bf9\u5e94&#xff1a;\u6240\u6709\u6848\u4f8b\u5747\u8bbe\u7f6e\u4e86constrain()\u51fd\u6570\u9650\u5236\u8f93\u51fa\u8303\u56f4&#xff0c;\u6848\u4f8b3\u8fd8\u52a0\u5165\u4e86Wi-Fi\u8fdc\u7a0b\u76d1\u63a7&#xff0c;\u4fbf\u4e8e\u533b\u62a4\u4eba\u5458\u53ca\u65f6\u5e72\u9884\u3002<\/li>\n<li>\u4eba\u4f53\u610f\u56fe\u611f\u77e5&#xff1a;\u201c\u51c6\u786e\u201d\u6bd4\u201c\u590d\u6742\u201d\u66f4\u91cd\u8981<br \/>\n\u610f\u56fe\u8bc6\u522b\u7684\u51c6\u786e\u6027\u76f4\u63a5\u5f71\u54cd\u52a9\u884c\u6548\u679c&#xff0c;\u9700\u9009\u62e9\u9ad8\u4fe1\u566a\u6bd4\u7684\u4f20\u611f\u5668\u5e76\u4f18\u5316\u7b97\u6cd5&#xff1a;<br \/>\nEMG\u4f20\u611f\u5668&#xff1a;\u9700\u8d34\u9644\u5728\u808c\u8089\u4e30\u539a\u5904&#xff08;\u5982\u80a1\u56db\u5934\u808c\u3001\u8158\u7ef3\u808c&#xff09;&#xff0c;\u5e76\u7528\u5dee\u5206\u653e\u5927\u7535\u8def\u53bb\u9664\u5171\u6a21\u5e72\u6270&#xff1b;<br \/>\n\u538b\u529b\u4f20\u611f\u5668&#xff1a;\u5206\u5e03\u5728\u8db3\u5e95\u53d7\u529b\u5173\u952e\u70b9&#xff08;\u524d\u638c\u3001\u540e\u8ddf\u3001\u5185\u4fa7\u3001\u5916\u4fa7&#xff09;&#xff0c;\u63d0\u9ad8\u91cd\u5fc3\u8ba1\u7b97\u7cbe\u5ea6&#xff1b;<br \/>\n\u7b97\u6cd5\u9009\u62e9&#xff1a;\u5165\u95e8\u7ea7\u7528\u9608\u503c\u6cd5&#xff08;\u7b80\u5355\u53ef\u9760&#xff09;&#xff0c;\u8fdb\u9636\u7ea7\u7528\u652f\u6301\u5411\u91cf\u673a&#xff08;SVM&#xff09;\u6216\u968f\u673a\u68ee\u6797&#xff08;\u8bc6\u522b\u66f4\u591a\u8fd0\u52a8\u6a21\u5f0f&#xff09;\u3002<br \/>\n\u6848\u4f8b\u5bf9\u5e94&#xff1a;\u6848\u4f8b1\u7528\u9608\u503c\u6cd5\u8bc6\u522b\u62ac\u817f\u610f\u56fe&#xff0c;\u6848\u4f8b3\u7528\u5361\u5c14\u66fc\u6ee4\u6ce2\u878d\u5408\u591a\u6e90\u6570\u636e&#xff0c;\u63d0\u5347\u8bc6\u522b\u51c6\u786e\u7387\u3002<\/li>\n<li>\u4eba\u673a\u534f\u540c\u63a7\u5236&#xff1a;\u201c\u8ddf\u968f\u6027\u201d\u4e0e\u201c\u8212\u9002\u6027\u201d\u5e73\u8861<br \/>\n\u5916\u9aa8\u9abc\u9700\u4e0e\u4eba\u4f53\u8fd0\u52a8\u540c\u6b65&#xff0c;\u65e2\u4e0d\u80fd\u201c\u6ede\u540e\u201d&#xff08;\u5bfc\u81f4\u6454\u5012&#xff09;&#xff0c;\u4e5f\u4e0d\u80fd\u201c\u8d85\u524d\u201d&#xff08;\u963b\u788d\u81ea\u4e3b\u8fd0\u52a8&#xff09;\u3002\u5e38\u7528\u963b\u6297\u63a7\u5236\u6216\u5bfc\u7eb3\u63a7\u5236&#xff1a;<br \/>\n\u963b\u6297\u63a7\u5236&#xff1a;\u8c03\u6574\u7535\u673a\u7684\u201c\u521a\u5ea6\u201d&#xff08;\u5982\u7528\u6237\u7528\u529b\u5927\u65f6&#xff0c;\u7535\u673a\u53d8\u201c\u8f6f\u201d&#xff0c;\u51cf\u5c11\u5bf9\u6297&#xff09;&#xff1b;<br \/>\n\u5bfc\u7eb3\u63a7\u5236&#xff1a;\u5c06\u7535\u673a\u529b\u8f6c\u6362\u4e3a\u901f\u5ea6&#xff08;\u5982\u7528\u6237\u60f3\u5feb\u901f\u62ac\u817f\u65f6&#xff0c;\u7535\u673a\u63d0\u9ad8\u8f6c\u901f&#xff09;\u3002<br \/>\n\u6848\u4f8b\u5bf9\u5e94&#xff1a;\u6848\u4f8b1\u7528PID\u8ddf\u8e2a\u5173\u8282\u89d2\u5ea6&#xff0c;\u6848\u4f8b2\u7528\u6a21\u7cca\u903b\u8f91\u8c03\u6574\u529b\u77e9&#xff0c;\u672c\u8d28\u90fd\u662f\u4e3a\u4e86\u8ba9\u7535\u673a\u201c\u8ddf\u968f\u201d\u4eba\u4f53\u8fd0\u52a8\u3002<\/li>\n<li>\u529f\u7387\u5bc6\u5ea6\u4e0e\u7eed\u822a&#xff1a;\u201c\u8f7b\u91cf\u5316\u201d\u4e0e\u201c\u52a8\u529b\u201d\u517c\u987e<br \/>\n\u533b\u7597\u5916\u9aa8\u9abc\u9700\u4f69\u6234\u5728\u8eab\u4e0a&#xff0c;\u91cd\u91cf\u548c\u7eed\u822a\u662f\u5173\u952e\u6307\u6807&#xff1a;<br \/>\n\u7535\u673a\u9009\u62e9&#xff1a;\u4f18\u5148\u9009\u65e0\u5237\u5916\u8f6c\u5b50\u7535\u673a&#xff08;\u529f\u7387\u5bc6\u5ea6\u9ad8\u3001\u626d\u77e9\u5927\u3001\u4f53\u79ef\u5c0f&#xff09;&#xff0c;\u5982Maxon EC-i40&#xff1b;<br \/>\n\u7535\u6c60\u9009\u62e9&#xff1a;\u7528\u9ad8\u80fd\u91cf\u5bc6\u5ea6\u9502\u7535\u6c60&#xff08;\u598218650&#xff0c;\u5bb9\u91cf3000mAh\u4ee5\u4e0a&#xff09;&#xff0c;\u4fdd\u8bc1\u81f3\u5c112\u5c0f\u65f6\u7eed\u822a&#xff1b;<br \/>\n\u8282\u80fd\u8bbe\u8ba1&#xff1a;\u7a7a\u95f2\u65f6\u8fdb\u5165\u4f4e\u529f\u8017\u6a21\u5f0f&#xff08;\u5982\u6848\u4f8b1\u4e2dstepIntent&#061;false\u65f6\u505c\u6b62\u7535\u673a&#xff09;&#xff0c;\u51cf\u5c11\u7535\u91cf\u6d88\u8017\u3002<br \/>\n\u6848\u4f8b\u5bf9\u5e94&#xff1a;\u6240\u6709\u6848\u4f8b\u5747\u91c7\u7528\u5c0f\u578bBLDC\u7535\u673a&#xff0c;\u6848\u4f8b3\u52a0\u5165Wi-Fi\u8fdc\u7a0b\u76d1\u63a7&#xff0c;\u907f\u514d\u9891\u7e41\u66f4\u6362\u7535\u6c60\u3002<\/li>\n<li>\u4e2a\u6027\u5316\u9002\u914d&#xff1a;\u201c\u6a21\u5757\u5316\u201d\u8bbe\u8ba1\u964d\u4f4e\u4f7f\u7528\u95e8\u69db<br \/>\n\u4e0d\u540c\u60a3\u8005\u7684\u8eab\u9ad8\u3001\u4f53\u91cd\u3001\u8fd0\u52a8\u80fd\u529b\u5dee\u5f02\u5927&#xff0c;\u9700\u8bbe\u8ba1\u6a21\u5757\u5316\u7ed3\u6784&#xff0c;\u65b9\u4fbf\u8c03\u6574&#xff1a;<br \/>\n\u673a\u68b0\u7ed3\u6784&#xff1a;\u91c7\u7528\u94dd\u5408\u91d1\u6216\u78b3\u7ea4\u7ef4\u6750\u8d28&#xff0c;\u5173\u8282\u957f\u5ea6\u53ef\u8c03\u8282&#xff08;\u5982\u9acb\u5173\u8282\u6746\u4f38\u7f29&#xff09;&#xff1b;<br \/>\n\u8f6f\u4ef6\u53c2\u6570&#xff1a;\u5b58\u50a8\u591a\u7ec4\u7528\u6237\u914d\u7f6e&#xff08;\u5982EMG\u9608\u503c\u3001PID\u53c2\u6570&#xff09;&#xff0c;\u901a\u8fc7\u84dd\u7259\/Wi-Fi\u4e00\u952e\u5207\u6362&#xff1b;<br \/>\n\u6821\u51c6\u529f\u80fd&#xff1a;\u5f00\u673a\u65f6\u81ea\u52a8\u6821\u51c6\u4f20\u611f\u5668&#xff08;\u5982IMU\u7684\u96f6\u504f\u3001\u538b\u529b\u4f20\u611f\u5668\u7684\u521d\u59cb\u503c&#xff09;&#xff0c;\u6d88\u9664\u4e2a\u4f53\u5dee\u5f02\u3002<br \/>\n\u6848\u4f8b\u5bf9\u5e94&#xff1a;\u6848\u4f8b1\u4e2d\u7684EMG\u9608\u503c\u53ef\u6839\u636e\u7528\u6237\u9700\u6c42\u8c03\u6574&#xff08;\u4ee3\u7801\u4e2d0.8V\u53ef\u6539\u4e3a\u5176\u4ed6\u503c&#xff09;&#xff0c;\u6848\u4f8b3\u7684\u5361\u5c14\u66fc\u6ee4\u6ce2\u53c2\u6570\u53ef\u901a\u8fc7\u4e91\u7aef\u8fdc\u7a0b\u6821\u51c6\u3002<\/li>\n<p><img decoding=\"async\" src=\"https:\/\/www.wsisp.com\/helps\/wp-content\/uploads\/2026\/01\/20260120122620-696f746c87577.jpg\" alt=\"\u5728\u8fd9\u91cc\u63d2\u5165\u56fe\u7247\u63cf\u8ff0\" \/><br \/>\n4\u3001\u819d\u5173\u8282\u52a9\u529b\u63a7\u5236&#xff08;\u57fa\u4e8eIMU\u7684\u6b65\u6001\u76f8\u4f4d\u68c0\u6d4b&#xff09;<\/p>\n<p><span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;MPU6050.h&gt;<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;Encoder.h&gt;<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;SimpleFOC.h&gt;<\/span><\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u786c\u4ef6\u914d\u7f6e<\/span><br \/>\nMPU6050 imu<span class=\"token punctuation\">;<\/span><br \/>\nEncoder <span class=\"token function\">kneeEncoder<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">2<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">3<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u7f16\u7801\u5668\u63a5\u53e3<\/span><br \/>\nBLDCMotor <span class=\"token function\">motor<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">9<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span>         <span class=\"token comment\">\/\/ BLDC\u7535\u673aPWM\u5f15\u811a<\/span><br \/>\nBLDCDriver3PWM <span class=\"token function\">driver<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">5<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">6<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">7<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u4e09\u76f8\u9a71\u52a8\u5f15\u811a<\/span><\/p>\n<p><span class=\"token comment\">\/\/ \u6b65\u6001\u53c2\u6570<\/span><br \/>\n<span class=\"token keyword\">float<\/span> gaitPhase <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token keyword\">const<\/span> <span class=\"token keyword\">float<\/span> stanceThreshold <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.3<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u7ad9\u7acb\u76f8\u9608\u503c<\/span><br \/>\n<span class=\"token keyword\">const<\/span> <span class=\"token keyword\">float<\/span> swingThreshold <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.7<\/span><span class=\"token punctuation\">;<\/span>  <span class=\"token comment\">\/\/ \u6446\u52a8\u76f8\u9608\u503c<\/span><\/p>\n<p><span class=\"token keyword\">void<\/span> <span class=\"token function\">setup<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  Serial<span class=\"token punctuation\">.<\/span><span class=\"token function\">begin<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">115200<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  imu<span class=\"token punctuation\">.<\/span><span class=\"token function\">initialize<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  motor<span class=\"token punctuation\">.<\/span><span class=\"token function\">linkDriver<\/span><span class=\"token punctuation\">(<\/span><span class=\"token operator\">&amp;<\/span>driver<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  motor<span class=\"token punctuation\">.<\/span>controller <span class=\"token operator\">&#061;<\/span> MotionControlType<span class=\"token double-colon punctuation\">::<\/span>torque<span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u529b\u77e9\u6a21\u5f0f<\/span><br \/>\n  motor<span class=\"token punctuation\">.<\/span>voltage_sensor_align <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">3<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u7535\u673a\u5bf9\u9f50<\/span><br \/>\n  motor<span class=\"token punctuation\">.<\/span><span class=\"token function\">init<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token keyword\">void<\/span> <span class=\"token function\">loop<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  <span class=\"token comment\">\/\/ 1. \u83b7\u53d6IMU\u6570\u636e&#xff08;\u7b80\u5316\u7248&#xff09;<\/span><br \/>\n  <span class=\"token keyword\">int16_t<\/span> ax<span class=\"token punctuation\">,<\/span> ay<span class=\"token punctuation\">,<\/span> az<span class=\"token punctuation\">;<\/span><br \/>\n  imu<span class=\"token punctuation\">.<\/span><span class=\"token function\">getAcceleration<\/span><span class=\"token punctuation\">(<\/span><span class=\"token operator\">&amp;<\/span>ax<span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&amp;<\/span>ay<span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&amp;<\/span>az<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> kneeAngle <span class=\"token operator\">&#061;<\/span> kneeEncoder<span class=\"token punctuation\">.<\/span><span class=\"token function\">read<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">*<\/span> <span class=\"token number\">0.01<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u7f16\u7801\u5668\u89d2\u5ea6\u8f6c\u6362<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 2. \u6b65\u6001\u76f8\u4f4d\u68c0\u6d4b&#xff08;\u7b80\u5316\u903b\u8f91&#xff09;<\/span><br \/>\n  <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>az <span class=\"token operator\">&gt;<\/span> <span class=\"token number\">0.8<\/span><span class=\"token punctuation\">)<\/span> gaitPhase <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u7ad9\u7acb\u76f8\u5f00\u59cb<\/span><br \/>\n  <span class=\"token keyword\">else<\/span> <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>az <span class=\"token operator\">&lt;<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">0.8<\/span><span class=\"token punctuation\">)<\/span> gaitPhase <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.6<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u6446\u52a8\u76f8\u5f00\u59cb<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 3. \u52a9\u529b\u63a7\u5236\u7b56\u7565<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> torqueCommand <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>gaitPhase <span class=\"token operator\">&lt;<\/span> stanceThreshold<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    torqueCommand <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.5<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u7ad9\u7acb\u76f8\u63d0\u4f9b50%\u52a9\u529b<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span> <span class=\"token keyword\">else<\/span> <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>gaitPhase <span class=\"token operator\">&gt;<\/span> swingThreshold<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    torqueCommand <span class=\"token operator\">&#061;<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">0.3<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u6446\u52a8\u76f8\u8f7b\u5fae\u5236\u52a8<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span><br \/>\n  motor<span class=\"token punctuation\">.<\/span><span class=\"token function\">move<\/span><span class=\"token punctuation\">(<\/span>torqueCommand<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 4. \u5b89\u5168\u76d1\u63a7<\/span><br \/>\n  <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>motor<span class=\"token punctuation\">.<\/span>current_sense<span class=\"token punctuation\">.<\/span><span class=\"token function\">current<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&gt;<\/span> <span class=\"token number\">5.0<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span> <span class=\"token comment\">\/\/ \u8fc7\u6d41\u4fdd\u62a4<\/span><br \/>\n    motor<span class=\"token punctuation\">.<\/span><span class=\"token function\">stop<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    Serial<span class=\"token punctuation\">.<\/span><span class=\"token function\">println<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;Overcurrent detected!&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span><br \/>\n  <span class=\"token function\">delay<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">10<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p>5\u3001\u9acb\u5173\u8282\u591a\u6a21\u5f0f\u5207\u6362&#xff08;\u4f4d\u7f6e\/\u529b\u77e9\u6df7\u5408\u63a7\u5236&#xff09;<\/p>\n<p><span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;Servo.h&gt;<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;Encoder.h&gt;<\/span><\/span><\/p>\n<p>Servo hipMotor<span class=\"token punctuation\">;<\/span><br \/>\nEncoder <span class=\"token function\">hipEncoder<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">2<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">3<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token keyword\">const<\/span> <span class=\"token keyword\">int<\/span> modePin <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">4<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u6a21\u5f0f\u5207\u6362\u6309\u94ae<\/span><\/p>\n<p><span class=\"token keyword\">void<\/span> <span class=\"token function\">setup<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  hipMotor<span class=\"token punctuation\">.<\/span><span class=\"token function\">attach<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">9<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">pinMode<\/span><span class=\"token punctuation\">(<\/span>modePin<span class=\"token punctuation\">,<\/span> INPUT_PULLUP<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  Serial<span class=\"token punctuation\">.<\/span><span class=\"token function\">begin<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">9600<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token keyword\">void<\/span> <span class=\"token function\">loop<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  <span class=\"token keyword\">static<\/span> <span class=\"token keyword\">bool<\/span> isTorqueMode <span class=\"token operator\">&#061;<\/span> <span class=\"token boolean\">false<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">long<\/span> currentPos <span class=\"token operator\">&#061;<\/span> hipEncoder<span class=\"token punctuation\">.<\/span><span class=\"token function\">read<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ \u6a21\u5f0f\u5207\u6362\u68c0\u6d4b<\/span><br \/>\n  <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token function\">digitalRead<\/span><span class=\"token punctuation\">(<\/span>modePin<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#061;&#061;<\/span> LOW<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    isTorqueMode <span class=\"token operator\">&#061;<\/span> <span class=\"token operator\">!<\/span>isTorqueMode<span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token function\">delay<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">300<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u9632\u6296<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ \u63a7\u5236\u7b56\u7565<\/span><br \/>\n  <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>isTorqueMode<span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    <span class=\"token comment\">\/\/ \u529b\u77e9\u6a21\u5f0f&#xff1a;\u6839\u636e\u89d2\u5ea6\u504f\u5dee\u63d0\u4f9b\u52a9\u529b<\/span><br \/>\n    <span class=\"token keyword\">float<\/span> error <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">90<\/span> <span class=\"token operator\">&#8211;<\/span> currentPos <span class=\"token operator\">*<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u76ee\u6807\u89d2\u5ea690\u00b0<\/span><br \/>\n    <span class=\"token keyword\">float<\/span> torque <span class=\"token operator\">&#061;<\/span> <span class=\"token function\">map<\/span><span class=\"token punctuation\">(<\/span>error<span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">90<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">90<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">50<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">50<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u7ebf\u6027\u6620\u5c04<\/span><br \/>\n    hipMotor<span class=\"token punctuation\">.<\/span><span class=\"token function\">writeMicroseconds<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">1500<\/span> <span class=\"token operator\">&#043;<\/span> torque<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u4e2d\u7acb\u4f4d1500\u03bcs<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span> <span class=\"token keyword\">else<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    <span class=\"token comment\">\/\/ \u4f4d\u7f6e\u6a21\u5f0f&#xff1a;\u76f4\u63a5\u63a7\u5236\u89d2\u5ea6<\/span><br \/>\n    <span class=\"token keyword\">int<\/span> targetAngle <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">90<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    hipMotor<span class=\"token punctuation\">.<\/span><span class=\"token function\">write<\/span><span class=\"token punctuation\">(<\/span>targetAngle <span class=\"token operator\">*<\/span> <span class=\"token number\">0.56<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ 0-180\u00b0\u6620\u5c04\u52300-100\u03bcs<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span><\/p>\n<p>  Serial<span class=\"token punctuation\">.<\/span><span class=\"token function\">print<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;Mode: &#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  Serial<span class=\"token punctuation\">.<\/span><span class=\"token function\">print<\/span><span class=\"token punctuation\">(<\/span>isTorqueMode <span class=\"token operator\">?<\/span> <span class=\"token string\">&#034;Torque&#034;<\/span> <span class=\"token operator\">:<\/span> <span class=\"token string\">&#034;Position&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  Serial<span class=\"token punctuation\">.<\/span><span class=\"token function\">print<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034; Angle: &#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  Serial<span class=\"token punctuation\">.<\/span><span class=\"token function\">println<\/span><span class=\"token punctuation\">(<\/span>currentPos <span class=\"token operator\">*<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token function\">delay<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">50<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p>6\u3001\u591a\u5173\u8282\u534f\u540c\u63a7\u5236&#xff08;\u57fa\u4e8eCAN\u603b\u7ebf\u901a\u4fe1&#xff09;<\/p>\n<p><span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;mcp_can.h&gt;<\/span><\/span><br \/>\n<span class=\"token macro property\"><span class=\"token directive-hash\">#<\/span><span class=\"token directive keyword\">include<\/span> <span class=\"token string\">&lt;Encoder.h&gt;<\/span><\/span><\/p>\n<p>MCP_CAN <span class=\"token function\">can<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">10<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ CAN\u603b\u7ebf\u63a5\u53e3<\/span><br \/>\nEncoder <span class=\"token function\">kneeEnc<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">2<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">3<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\nEncoder <span class=\"token function\">hipEnc<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">4<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">5<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p><span class=\"token keyword\">struct<\/span> <span class=\"token class-name\">JointCommand<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> targetAngle<span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> maxTorque<span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p><span class=\"token keyword\">void<\/span> <span class=\"token function\">setup<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  Serial<span class=\"token punctuation\">.<\/span><span class=\"token function\">begin<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">115200<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">while<\/span> <span class=\"token punctuation\">(<\/span>CAN_OK <span class=\"token operator\">!&#061;<\/span> can<span class=\"token punctuation\">.<\/span><span class=\"token function\">begin<\/span><span class=\"token punctuation\">(<\/span>CAN_500KBPS<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span> <span class=\"token comment\">\/\/ \u521d\u59cb\u5316CAN\u603b\u7ebf<\/span><br \/>\n    Serial<span class=\"token punctuation\">.<\/span><span class=\"token function\">println<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;CAN init failed&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token function\">delay<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">100<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span><br \/>\n  Serial<span class=\"token punctuation\">.<\/span><span class=\"token function\">println<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;CAN init OK&#034;<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p><span class=\"token keyword\">void<\/span> <span class=\"token function\">loop<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n  <span class=\"token comment\">\/\/ 1. \u8bfb\u53d6\u7f16\u7801\u5668\u6570\u636e<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> kneeAngle <span class=\"token operator\">&#061;<\/span> kneeEnc<span class=\"token punctuation\">.<\/span><span class=\"token function\">read<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">*<\/span> <span class=\"token number\">0.01<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span> hipAngle <span class=\"token operator\">&#061;<\/span> hipEnc<span class=\"token punctuation\">.<\/span><span class=\"token function\">read<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token operator\">*<\/span> <span class=\"token number\">0.01<\/span><span class=\"token punctuation\">;<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 2. \u53d1\u9001\u5173\u8282\u72b6\u6001&#xff08;\u7b80\u5316\u7248&#xff09;<\/span><br \/>\n  <span class=\"token keyword\">unsigned<\/span> <span class=\"token keyword\">char<\/span> canMsg<span class=\"token punctuation\">[<\/span><span class=\"token number\">8<\/span><span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">{<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">}<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">float<\/span><span class=\"token operator\">*<\/span> ptr <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token keyword\">float<\/span><span class=\"token operator\">*<\/span><span class=\"token punctuation\">)<\/span>canMsg<span class=\"token punctuation\">;<\/span><br \/>\n  ptr<span class=\"token punctuation\">[<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> kneeAngle<span class=\"token punctuation\">;<\/span><br \/>\n  ptr<span class=\"token punctuation\">[<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> hipAngle<span class=\"token punctuation\">;<\/span><br \/>\n  can<span class=\"token punctuation\">.<\/span><span class=\"token function\">sendMsgBuf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">0x100<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">8<\/span><span class=\"token punctuation\">,<\/span> canMsg<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> <span class=\"token comment\">\/\/ \u53d1\u9001\u5230ID 0x100<\/span><\/p>\n<p>  <span class=\"token comment\">\/\/ 3. \u63a5\u6536\u63a7\u5236\u6307\u4ee4<\/span><br \/>\n  <span class=\"token keyword\">unsigned<\/span> <span class=\"token keyword\">char<\/span> len <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">unsigned<\/span> <span class=\"token keyword\">char<\/span> buf<span class=\"token punctuation\">[<\/span><span class=\"token number\">8<\/span><span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">;<\/span><br \/>\n  <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>CAN_MSGAVAIL <span class=\"token operator\">&#061;&#061;<\/span> can<span class=\"token punctuation\">.<\/span><span class=\"token function\">checkReceive<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span><br \/>\n    can<span class=\"token punctuation\">.<\/span><span class=\"token function\">readMsgBuf<\/span><span class=\"token punctuation\">(<\/span><span class=\"token operator\">&amp;<\/span>len<span class=\"token punctuation\">,<\/span> buf<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n    <span class=\"token keyword\">if<\/span> <span class=\"token punctuation\">(<\/span>buf<span class=\"token punctuation\">[<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;&#061;<\/span> <span class=\"token number\">0x01<\/span><span class=\"token punctuation\">)<\/span> <span class=\"token punctuation\">{<\/span> <span class=\"token comment\">\/\/ \u819d\u5173\u8282\u6307\u4ee4<\/span><br \/>\n      JointCommand cmd<span class=\"token punctuation\">;<\/span><br \/>\n      <span class=\"token function\">memcpy<\/span><span class=\"token punctuation\">(<\/span><span class=\"token operator\">&amp;<\/span>cmd<span class=\"token punctuation\">,<\/span> buf <span class=\"token operator\">&#043;<\/span> <span class=\"token number\">1<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token keyword\">sizeof<\/span><span class=\"token punctuation\">(<\/span>cmd<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n      <span class=\"token comment\">\/\/ \u6267\u884c\u819d\u5173\u8282\u63a7\u5236&#xff08;\u6b64\u5904\u7701\u7565\u5177\u4f53\u5b9e\u73b0&#xff09;<\/span><br \/>\n    <span class=\"token punctuation\">}<\/span><br \/>\n  <span class=\"token punctuation\">}<\/span><br \/>\n  <span class=\"token function\">delay<\/span><span class=\"token punctuation\">(<\/span><span class=\"token number\">20<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span><br \/>\n<span class=\"token punctuation\">}<\/span><\/p>\n<p>\u8981\u70b9\u89e3\u8bfb<br \/>\n\u4f20\u611f\u5668\u878d\u5408\u4e0e\u6b65\u6001\u8bc6\u522b<br \/>\n\u533b\u7597\u5916\u9aa8\u9abc\u9700\u901a\u8fc7IMU\u3001\u538b\u529b\u4f20\u611f\u5668\u7b49\u591a\u6a21\u6001\u6570\u636e\u878d\u5408\u8bc6\u522b\u6b65\u6001\u76f8\u4f4d&#xff08;\u5982\u7ad9\u7acb\u76f8\/\u6446\u52a8\u76f8&#xff09;\u3002<br \/>\n\u793a\u4f8b\u4ee3\u78014\u4e2d\u901a\u8fc7\u52a0\u901f\u5ea6\u8ba1\u9608\u503c\u7b80\u5316\u6b65\u6001\u68c0\u6d4b&#xff0c;\u5b9e\u9645\u9700\u7ed3\u5408\u9640\u87ba\u4eea\u79ef\u5206\u4e0e\u673a\u5668\u5b66\u4e60\u7b97\u6cd5\u63d0\u9ad8\u51c6\u786e\u6027\u3002<br \/>\n\u63a7\u5236\u6a21\u5f0f\u5207\u6362<br \/>\n\u9700\u652f\u6301\u4f4d\u7f6e\u63a7\u5236&#xff08;\u7cbe\u786e\u8f68\u8ff9\u8ddf\u8e2a&#xff09;\u4e0e\u529b\u77e9\u63a7\u5236&#xff08;\u67d4\u987a\u4ea4\u4e92&#xff09;\u7684\u52a8\u6001\u5207\u6362&#xff08;\u5982\u6848\u4f8b5&#xff09;\u3002<br \/>\n\u533b\u7597\u573a\u666f\u4e2d&#xff0c;\u529b\u77e9\u6a21\u5f0f\u7528\u4e8e\u8f85\u52a9\u60a3\u8005\u4e3b\u52a8\u8fd0\u52a8&#xff0c;\u4f4d\u7f6e\u6a21\u5f0f\u7528\u4e8e\u88ab\u52a8\u5eb7\u590d\u8bad\u7ec3\u3002<br \/>\n\u5b9e\u65f6\u6027\u4e0e\u5b89\u5168\u6027<br \/>\n\u63a7\u5236\u5468\u671f\u9700\u226410ms&#xff08;\u5982\u6848\u4f8b4\u768410ms\u5ef6\u8fdf&#xff09;\u4ee5\u6ee1\u8db3\u4eba\u4f53\u8fd0\u52a8\u54cd\u5e94\u9700\u6c42\u3002<br \/>\n\u5fc5\u987b\u5b9e\u73b0\u8fc7\u6d41\u4fdd\u62a4&#xff08;\u5982\u6848\u4f8b4\u7684current_sense\u68c0\u6d4b&#xff09;\u3001\u6025\u505c\u6309\u94ae\u3001\u673a\u68b0\u9650\u4f4d\u7b49\u5b89\u5168\u673a\u5236\u3002<br \/>\n\u591a\u5173\u8282\u534f\u540c\u4e0e\u901a\u4fe1<br \/>\n\u5206\u5e03\u5f0f\u67b6\u6784&#xff08;\u5982\u6848\u4f8b6\u7684CAN\u603b\u7ebf&#xff09;\u53ef\u964d\u4f4e\u4e3b\u63a7\u8d1f\u62c5&#xff0c;\u652f\u6301\u6a21\u5757\u5316\u6269\u5c55\u3002<br \/>\n\u9700\u540c\u6b65\u5404\u5173\u8282\u8fd0\u52a8\u4ee5\u907f\u514d\u673a\u68b0\u51b2\u7a81&#xff08;\u5982\u6848\u4f8b6\u4e2d\u901a\u8fc7\u65f6\u95f4\u6233\u6216\u5171\u4eab\u65f6\u949f\u5b9e\u73b0\u540c\u6b65&#xff09;\u3002<br \/>\n\u7535\u6e90\u7ba1\u7406\u4e0e\u70ed\u8bbe\u8ba1<br \/>\nBLDC\u7535\u673a\u542f\u505c\u77ac\u6001\u7535\u6d41\u53ef\u8fbe10A\u4ee5\u4e0a&#xff0c;\u9700\u4f7f\u7528\u9ad8\u500d\u7387\u9502\u7535\u6c60&#xff08;\u59824S LiPo&#xff09;\u6216\u7a33\u538b\u7535\u6e90\u3002<br \/>\n\u7535\u673a\u5916\u58f3\u9700\u96c6\u6210\u6e29\u5ea6\u4f20\u611f\u5668&#xff08;\u5982DS18B20&#xff09;&#xff0c;\u52a8\u6001\u964d\u989d\u8fd0\u884c\u9632\u6b62\u8fc7\u70ed&#xff08;\u53c2\u8003\u6848\u4f8b\u4e2d\u7684\u6e29\u5347\u7ba1\u7406&#xff09;\u3002<\/p>\n<p>\u6ce8\u610f&#xff0c;\u4ee5\u4e0a\u6848\u4f8b\u53ea\u662f\u4e3a\u4e86\u62d3\u5c55\u601d\u8def&#xff0c;\u4ec5\u4f9b\u53c2\u8003\u3002\u5b83\u4eec\u53ef\u80fd\u6709\u9519\u8bef\u3001\u4e0d\u9002\u7528\u6216\u8005\u65e0\u6cd5\u7f16\u8bd1\u3002\u60a8\u7684\u786c\u4ef6\u5e73\u53f0\u3001\u4f7f\u7528\u573a\u666f\u548cArduino\u7248\u672c\u53ef\u80fd\u5f71\u54cd\u4f7f\u7528\u65b9\u6cd5\u7684\u9009\u62e9\u3002\u5b9e\u9645\u7f16\u7a0b\u65f6&#xff0c;\u60a8\u8981\u6839\u636e\u81ea\u5df1\u7684\u786c\u4ef6\u914d\u7f6e\u3001\u4f7f\u7528\u573a\u666f\u548c\u5177\u4f53\u9700\u6c42\u8fdb\u884c\u8c03\u6574&#xff0c;\u5e76\u591a\u6b21\u5b9e\u9645\u6d4b\u8bd5\u3002\u60a8\u8fd8\u8981\u6b63\u786e\u8fde\u63a5\u786c\u4ef6&#xff0c;\u4e86\u89e3\u6240\u7528\u4f20\u611f\u5668\u548c\u8bbe\u5907\u7684\u89c4\u8303\u548c\u7279\u6027\u3002\u6d89\u53ca\u786c\u4ef6\u64cd\u4f5c\u7684\u4ee3\u7801&#xff0c;\u60a8\u8981\u5728\u4f7f\u7528\u524d\u786e\u8ba4\u5f15\u811a\u548c\u7535\u5e73\u7b49\u53c2\u6570\u7684\u6b63\u786e\u6027\u548c\u5b89\u5168\u6027\u3002<\/p>\n<p><img decoding=\"async\" src=\"https:\/\/www.wsisp.com\/helps\/wp-content\/uploads\/2026\/01\/20260120122621-696f746d367aa.jpg\" alt=\"\u5728\u8fd9\u91cc\u63d2\u5165\u56fe\u7247\u63cf\u8ff0\" \/><\/p>\n","protected":false},"excerpt":{"rendered":"<p>\u8fd9\u662f\u4e00\u4e2a\u9ad8\u5ea6\u8de8\u5b66\u79d1\u7684\u524d\u6cbf\u5e94\u7528&#xff0c;\u878d\u5408\u4e86\u5d4c\u5165\u5f0f\u7cfb\u7edf\u3001\u9ad8\u6548\u7535\u673a\u9a71\u52a8\u3001\u751f\u7269\u529b\u5b66\u3001\u5eb7\u590d\u533b\u5b66\u3001\u4eba\u673a\u4ea4\u4e92\u548c\u4f20\u611f\u5668\u6280\u672f\u3002\u5176\u6838\u5fc3\u76ee\u6807\u662f\u4e3a\u4e0b\u80a2\u529f\u80fd\u969c\u788d\u8005&#xff08;\u5982\u4e2d\u98ce\u60a3\u8005\u3001\u810a\u9ad3\u635f\u4f24\u60a3\u8005\u3001\u8001\u5e74\u4eba&#xff09;\u63d0\u4f9b\u8f85\u52a9\u884c\u8d70\u3001\u652f\u6491\u4f53\u91cd\u3001\u52a9\u529b\u6216\u963b\u529b\u8bad\u7ec3\u7b49\u529f\u80fd\u3002<br \/>\n\u4e00\u3001 \u4e3b\u8981\u7279\u70b9 (Key Features)<br \/>\n\u9ad8\u6548\u3001\u9ad8\u626d\u77e9\u9a71\u52a8\u7cfb\u7edf (High-Efficiency, High-Torque Drive System):<br \/>\n\u6838\u5fc3: \u91c7\u7528BLDC\u7535\u673a\u4f5c\u4e3a\u5173\u8282\u9a71\u52a8\u5668&#xff0c;\u901a\u8fc7\u51cf\u901f\u5668<\/p>\n","protected":false},"author":2,"featured_media":62860,"comment_status":"open","ping_status":"open","sticky":false,"template":"","format":"standard","meta":{"footnotes":""},"categories":[1],"tags":[6648,6649,55,270,269],"topic":[],"class_list":["post-62864","post","type-post","status-publish","format-standard","has-post-thumbnail","hentry","category-server","tag-arduino-bldc","tag-6649","tag-c","tag-270","tag-269"],"yoast_head":"<!-- This site is optimized with the Yoast SEO plugin v20.3 - https:\/\/yoast.com\/wordpress\/plugins\/seo\/ -->\n<title>\u3010\u82b1\u96d5\u5b66\u7f16\u7a0b\u3011Arduino BLDC \u4e4b\u533b\u7597\u52a9\u884c\u5916\u9aa8\u9abc\u673a\u5668\u4eba - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3<\/title>\n<meta name=\"robots\" content=\"index, follow, max-snippet:-1, max-image-preview:large, max-video-preview:-1\" \/>\n<link rel=\"canonical\" href=\"https:\/\/www.wsisp.com\/helps\/62864.html\" \/>\n<meta property=\"og:locale\" content=\"zh_CN\" \/>\n<meta property=\"og:type\" content=\"article\" \/>\n<meta property=\"og:title\" content=\"\u3010\u82b1\u96d5\u5b66\u7f16\u7a0b\u3011Arduino BLDC \u4e4b\u533b\u7597\u52a9\u884c\u5916\u9aa8\u9abc\u673a\u5668\u4eba - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\" \/>\n<meta property=\"og:description\" content=\"\u8fd9\u662f\u4e00\u4e2a\u9ad8\u5ea6\u8de8\u5b66\u79d1\u7684\u524d\u6cbf\u5e94\u7528&#xff0c;\u878d\u5408\u4e86\u5d4c\u5165\u5f0f\u7cfb\u7edf\u3001\u9ad8\u6548\u7535\u673a\u9a71\u52a8\u3001\u751f\u7269\u529b\u5b66\u3001\u5eb7\u590d\u533b\u5b66\u3001\u4eba\u673a\u4ea4\u4e92\u548c\u4f20\u611f\u5668\u6280\u672f\u3002\u5176\u6838\u5fc3\u76ee\u6807\u662f\u4e3a\u4e0b\u80a2\u529f\u80fd\u969c\u788d\u8005&#xff08;\u5982\u4e2d\u98ce\u60a3\u8005\u3001\u810a\u9ad3\u635f\u4f24\u60a3\u8005\u3001\u8001\u5e74\u4eba&#xff09;\u63d0\u4f9b\u8f85\u52a9\u884c\u8d70\u3001\u652f\u6491\u4f53\u91cd\u3001\u52a9\u529b\u6216\u963b\u529b\u8bad\u7ec3\u7b49\u529f\u80fd\u3002 \u4e00\u3001 \u4e3b\u8981\u7279\u70b9 (Key Features) \u9ad8\u6548\u3001\u9ad8\u626d\u77e9\u9a71\u52a8\u7cfb\u7edf (High-Efficiency, High-Torque Drive System): \u6838\u5fc3: \u91c7\u7528BLDC\u7535\u673a\u4f5c\u4e3a\u5173\u8282\u9a71\u52a8\u5668&#xff0c;\u901a\u8fc7\u51cf\u901f\u5668\" \/>\n<meta property=\"og:url\" content=\"https:\/\/www.wsisp.com\/helps\/62864.html\" \/>\n<meta property=\"og:site_name\" content=\"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\" \/>\n<meta property=\"article:published_time\" content=\"2026-01-20T12:26:22+00:00\" \/>\n<meta property=\"og:image\" content=\"https:\/\/www.wsisp.com\/helps\/wp-content\/uploads\/2026\/01\/20260120122620-696f746c03ba2.gif\" \/>\n<meta name=\"author\" content=\"admin\" \/>\n<meta name=\"twitter:card\" content=\"summary_large_image\" \/>\n<meta name=\"twitter:label1\" content=\"\u4f5c\u8005\" \/>\n\t<meta name=\"twitter:data1\" content=\"admin\" \/>\n\t<meta name=\"twitter:label2\" content=\"\u9884\u8ba1\u9605\u8bfb\u65f6\u95f4\" \/>\n\t<meta name=\"twitter:data2\" content=\"9 \u5206\" \/>\n<script type=\"application\/ld+json\" class=\"yoast-schema-graph\">{\"@context\":\"https:\/\/schema.org\",\"@graph\":[{\"@type\":\"WebPage\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/62864.html\",\"url\":\"https:\/\/www.wsisp.com\/helps\/62864.html\",\"name\":\"\u3010\u82b1\u96d5\u5b66\u7f16\u7a0b\u3011Arduino BLDC \u4e4b\u533b\u7597\u52a9\u884c\u5916\u9aa8\u9abc\u673a\u5668\u4eba - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\",\"isPartOf\":{\"@id\":\"https:\/\/www.wsisp.com\/helps\/#website\"},\"datePublished\":\"2026-01-20T12:26:22+00:00\",\"dateModified\":\"2026-01-20T12:26:22+00:00\",\"author\":{\"@id\":\"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41\"},\"breadcrumb\":{\"@id\":\"https:\/\/www.wsisp.com\/helps\/62864.html#breadcrumb\"},\"inLanguage\":\"zh-Hans\",\"potentialAction\":[{\"@type\":\"ReadAction\",\"target\":[\"https:\/\/www.wsisp.com\/helps\/62864.html\"]}]},{\"@type\":\"BreadcrumbList\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/62864.html#breadcrumb\",\"itemListElement\":[{\"@type\":\"ListItem\",\"position\":1,\"name\":\"\u9996\u9875\",\"item\":\"https:\/\/www.wsisp.com\/helps\"},{\"@type\":\"ListItem\",\"position\":2,\"name\":\"\u3010\u82b1\u96d5\u5b66\u7f16\u7a0b\u3011Arduino BLDC \u4e4b\u533b\u7597\u52a9\u884c\u5916\u9aa8\u9abc\u673a\u5668\u4eba\"}]},{\"@type\":\"WebSite\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/#website\",\"url\":\"https:\/\/www.wsisp.com\/helps\/\",\"name\":\"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\",\"description\":\"\u9999\u6e2f\u670d\u52a1\u5668_\u9999\u6e2f\u4e91\u670d\u52a1\u5668\u8d44\u8baf_\u670d\u52a1\u5668\u5e2e\u52a9\u6587\u6863_\u670d\u52a1\u5668\u6559\u7a0b\",\"potentialAction\":[{\"@type\":\"SearchAction\",\"target\":{\"@type\":\"EntryPoint\",\"urlTemplate\":\"https:\/\/www.wsisp.com\/helps\/?s={search_term_string}\"},\"query-input\":\"required name=search_term_string\"}],\"inLanguage\":\"zh-Hans\"},{\"@type\":\"Person\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41\",\"name\":\"admin\",\"image\":{\"@type\":\"ImageObject\",\"inLanguage\":\"zh-Hans\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/image\/\",\"url\":\"https:\/\/gravatar.wp-china-yes.net\/avatar\/?s=96&d=mystery\",\"contentUrl\":\"https:\/\/gravatar.wp-china-yes.net\/avatar\/?s=96&d=mystery\",\"caption\":\"admin\"},\"sameAs\":[\"http:\/\/wp.wsisp.com\"],\"url\":\"https:\/\/www.wsisp.com\/helps\/author\/admin\"}]}<\/script>\n<!-- \/ Yoast SEO plugin. -->","yoast_head_json":{"title":"\u3010\u82b1\u96d5\u5b66\u7f16\u7a0b\u3011Arduino BLDC \u4e4b\u533b\u7597\u52a9\u884c\u5916\u9aa8\u9abc\u673a\u5668\u4eba - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","robots":{"index":"index","follow":"follow","max-snippet":"max-snippet:-1","max-image-preview":"max-image-preview:large","max-video-preview":"max-video-preview:-1"},"canonical":"https:\/\/www.wsisp.com\/helps\/62864.html","og_locale":"zh_CN","og_type":"article","og_title":"\u3010\u82b1\u96d5\u5b66\u7f16\u7a0b\u3011Arduino BLDC \u4e4b\u533b\u7597\u52a9\u884c\u5916\u9aa8\u9abc\u673a\u5668\u4eba - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","og_description":"\u8fd9\u662f\u4e00\u4e2a\u9ad8\u5ea6\u8de8\u5b66\u79d1\u7684\u524d\u6cbf\u5e94\u7528&#xff0c;\u878d\u5408\u4e86\u5d4c\u5165\u5f0f\u7cfb\u7edf\u3001\u9ad8\u6548\u7535\u673a\u9a71\u52a8\u3001\u751f\u7269\u529b\u5b66\u3001\u5eb7\u590d\u533b\u5b66\u3001\u4eba\u673a\u4ea4\u4e92\u548c\u4f20\u611f\u5668\u6280\u672f\u3002\u5176\u6838\u5fc3\u76ee\u6807\u662f\u4e3a\u4e0b\u80a2\u529f\u80fd\u969c\u788d\u8005&#xff08;\u5982\u4e2d\u98ce\u60a3\u8005\u3001\u810a\u9ad3\u635f\u4f24\u60a3\u8005\u3001\u8001\u5e74\u4eba&#xff09;\u63d0\u4f9b\u8f85\u52a9\u884c\u8d70\u3001\u652f\u6491\u4f53\u91cd\u3001\u52a9\u529b\u6216\u963b\u529b\u8bad\u7ec3\u7b49\u529f\u80fd\u3002 \u4e00\u3001 \u4e3b\u8981\u7279\u70b9 (Key Features) \u9ad8\u6548\u3001\u9ad8\u626d\u77e9\u9a71\u52a8\u7cfb\u7edf (High-Efficiency, High-Torque Drive System): \u6838\u5fc3: \u91c7\u7528BLDC\u7535\u673a\u4f5c\u4e3a\u5173\u8282\u9a71\u52a8\u5668&#xff0c;\u901a\u8fc7\u51cf\u901f\u5668","og_url":"https:\/\/www.wsisp.com\/helps\/62864.html","og_site_name":"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","article_published_time":"2026-01-20T12:26:22+00:00","og_image":[{"url":"https:\/\/www.wsisp.com\/helps\/wp-content\/uploads\/2026\/01\/20260120122620-696f746c03ba2.gif"}],"author":"admin","twitter_card":"summary_large_image","twitter_misc":{"\u4f5c\u8005":"admin","\u9884\u8ba1\u9605\u8bfb\u65f6\u95f4":"9 \u5206"},"schema":{"@context":"https:\/\/schema.org","@graph":[{"@type":"WebPage","@id":"https:\/\/www.wsisp.com\/helps\/62864.html","url":"https:\/\/www.wsisp.com\/helps\/62864.html","name":"\u3010\u82b1\u96d5\u5b66\u7f16\u7a0b\u3011Arduino BLDC \u4e4b\u533b\u7597\u52a9\u884c\u5916\u9aa8\u9abc\u673a\u5668\u4eba - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","isPartOf":{"@id":"https:\/\/www.wsisp.com\/helps\/#website"},"datePublished":"2026-01-20T12:26:22+00:00","dateModified":"2026-01-20T12:26:22+00:00","author":{"@id":"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41"},"breadcrumb":{"@id":"https:\/\/www.wsisp.com\/helps\/62864.html#breadcrumb"},"inLanguage":"zh-Hans","potentialAction":[{"@type":"ReadAction","target":["https:\/\/www.wsisp.com\/helps\/62864.html"]}]},{"@type":"BreadcrumbList","@id":"https:\/\/www.wsisp.com\/helps\/62864.html#breadcrumb","itemListElement":[{"@type":"ListItem","position":1,"name":"\u9996\u9875","item":"https:\/\/www.wsisp.com\/helps"},{"@type":"ListItem","position":2,"name":"\u3010\u82b1\u96d5\u5b66\u7f16\u7a0b\u3011Arduino BLDC \u4e4b\u533b\u7597\u52a9\u884c\u5916\u9aa8\u9abc\u673a\u5668\u4eba"}]},{"@type":"WebSite","@id":"https:\/\/www.wsisp.com\/helps\/#website","url":"https:\/\/www.wsisp.com\/helps\/","name":"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","description":"\u9999\u6e2f\u670d\u52a1\u5668_\u9999\u6e2f\u4e91\u670d\u52a1\u5668\u8d44\u8baf_\u670d\u52a1\u5668\u5e2e\u52a9\u6587\u6863_\u670d\u52a1\u5668\u6559\u7a0b","potentialAction":[{"@type":"SearchAction","target":{"@type":"EntryPoint","urlTemplate":"https:\/\/www.wsisp.com\/helps\/?s={search_term_string}"},"query-input":"required name=search_term_string"}],"inLanguage":"zh-Hans"},{"@type":"Person","@id":"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41","name":"admin","image":{"@type":"ImageObject","inLanguage":"zh-Hans","@id":"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/image\/","url":"https:\/\/gravatar.wp-china-yes.net\/avatar\/?s=96&d=mystery","contentUrl":"https:\/\/gravatar.wp-china-yes.net\/avatar\/?s=96&d=mystery","caption":"admin"},"sameAs":["http:\/\/wp.wsisp.com"],"url":"https:\/\/www.wsisp.com\/helps\/author\/admin"}]}},"_links":{"self":[{"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/posts\/62864","targetHints":{"allow":["GET"]}}],"collection":[{"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/posts"}],"about":[{"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/types\/post"}],"author":[{"embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/users\/2"}],"replies":[{"embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/comments?post=62864"}],"version-history":[{"count":0,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/posts\/62864\/revisions"}],"wp:featuredmedia":[{"embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/media\/62860"}],"wp:attachment":[{"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/media?parent=62864"}],"wp:term":[{"taxonomy":"category","embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/categories?post=62864"},{"taxonomy":"post_tag","embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/tags?post=62864"},{"taxonomy":"topic","embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/topic?post=62864"}],"curies":[{"name":"wp","href":"https:\/\/api.w.org\/{rel}","templated":true}]}}