Matlab做一个刚体运动仿真，模拟小车避障

最新推荐文章于 2025-07-14 09:22:59 发布

原创

最新推荐文章于 2025-07-14 09:22:59 发布 · 1.2w 阅读

54 ·

CC 4.0 BY-SA版权

文章标签：

#Matalab仿真

由于老师要求不用实现太复杂，自己也没花太多时间，就简单模拟小车（刚体）撞墙自动转弯，效果如下：

核心代码如下，还有几个是前后左右转动的子代码。

clear all;
clc;
close all;
%构造刚体
x=[0 10 -10 0 0];
 y=[10 -10 -10 10 0];
 fill(x,y,'b')
 hold on;
 %画布大小
 axis([-200,200,-200,200])
 g=[x;y];
 %规定运行区域
 center_x = -150;
 center_y = -150;
 center_width = 300;
 center_high = 300;
 rectangle('Position',[center_x,center_y,center_high,center_width],'Curvature', [0 0], 'edgecolor','r')
 right_flag = 0;
 left_flag = 0;
 go_up =1;
 go_flag = 1;
 go_down =0;
 
  for i = 0:1:500
      if(go_up == 1)
          g = go_ahead(g,0,1);
          pause(0.05);
          fill(g(1,:),g(2,:),'b');
      end;
      if(go_down == 1)
          g = go_ahead(g,0,-1);
          pause(0.05);
          fill(g(1,:),g(2,:),'b'); 
      end;
      if(left_flag == 1)
          g = go_ahead(g,-1,0);
          pause(0.05);