怎么在gazebo中施加作用力
这篇文章给大家介绍怎么在gazebo中施加作用力,内容非常详细,感兴趣的小伙伴们可以参考借鉴,希望对大家能有所帮助。
创新互联公司服务项目包括太白网站建设、太白网站制作、太白网页制作以及太白网络营销策划等。多年来,我们专注于互联网行业,利用自身积累的技术优势、行业经验、深度合作伙伴关系等,向广大中小型企业、政府机构等提供互联网行业的解决方案,太白网站推广取得了明显的社会效益与经济效益。目前,我们服务的客户以成都为中心已经辐射到太白省份的部分城市,未来相信会继续扩大服务区域并继续获得客户的支持与信任!
修改成虚拟机IP地址
ipaddress = '192.168.137.129';
初始化
rosinit(ipaddress)
获取gazebo元素
gazebo = ExampleHelperGazeboCommunicator();
新建并放置三个可以打开的门
doormodel = ExampleHelperGazeboModel('hinged_door','gazeboDB');
door1 = spawnModel(gazebo,doormodel,[-1.5 2.0 0]);
door2 = spawnModel(gazebo,doormodel,[-1.5 0.5 0],[0 0 pi]);
door3 = spawnModel(gazebo,doormodel,[-1.5 -2.5 0]);
获取第一个门的运动副
[links, joints] = getComponents(door1);
在第一个门的运动副上施加作用效果
stopTime = 5; % Seconds
effort = 3.0; % Newton-meters
jointTorque(door1, joints{2}, stopTime, effort);
在第二个门的运动副上施加力矩
forceVector = [0 0 0]; % Newtons
torqueVector = [0 0 3]; % Newton-meters
applyForce(door2, links{2}, stopTime, forceVector, torqueVector);
在第二个门的运动副上施加力
forceVector = [0 -2 0]; % Newtons
applyForce(door2, links{2}, stopTime, forceVector);
直接设置第三个门的运动副状态
angdelta = 0.1; % Radians
dt = 0; % Seconds
angle = 0; % Radians
tic
while (toc < stopTime)
if angle > 1.5 || angle < 0 % In radians
angdelta = -angdelta;
end
angle = angle+angdelta;
setConfig(door3,joints{2},angle);
pause(dt);
end
新建并放置一个新的移动robot
botmodel = ExampleHelperGazeboModel('turtlebot','gazeboDB');
bot = spawnModel(gazebo,botmodel,[1,0,0]);
设置robot的姿态
setState(bot,'orientation',[0 0 pi/2]);
获取robot的运动副
[botlinks, botjoints] = getComponents(bot);
在robot的运动副上施加作用效果
turnStopTime = 1; % Seconds
turnEffort = 0.2; % Newton-meters
jointTorque(bot, botjoints{2}, turnStopTime, turnEffort)
新建并放置一个新的移动robot2
bot2 = spawnModel(gazebo,botmodel,[2,0,0]);
[botlinks2, botjoints2] = getComponents(bot2);
在robot2的运动副上施加作用力
applyForce(bot2,botlinks2{1},2,[0 1 0]);
在robot2的运动副上施加作用力
applyForce(bot2,botlinks2{1},2,[1 0 0]);
在robot2的运动副上施加作用力矩
applyForce(bot2,botlinks2{1},2,[0 0 0],[0 0 1]);
新建具有弹性的小球
bounce = 1; % Unitless coefficient
maxCorrectionVelocity = 10; % Meters per second
ballmodel = ExampleHelperGazeboModel('ball');
addLink(ballmodel,'sphere',0.2,'color',[0.3 0.7 0.7 0.5],'bounce',[bounce maxCorrectionVelocity]);
放置具有弹性的一高一低小球两个
spawnModel(gazebo,ballmodel,[0 1 2]);
spawnModel(gazebo,ballmodel,[0 1 3]);
pause(5);
清除gazebo中的物体
exampleHelperGazeboCleanupApplyForces;
情况变量
clear
关闭连接
rosshutdown
关于怎么在gazebo中施加作用力就分享到这里了,希望以上内容可以对大家有一定的帮助,可以学到更多知识。如果觉得文章不错,可以把它分享出去让更多的人看到。
名称栏目:怎么在gazebo中施加作用力
本文来源:http://ybzwz.com/article/igshsp.html