V-rep Hexapod tutorial（2）

最新推荐文章于 2023-04-26 21:35:34 发布
最新推荐文章于 2023-04-26 21:35:34 发布
阅读量417 收藏 6
点赞数 1
分类专栏： vrep自学 文章标签： 算法
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/weixin_43986879/article/details/120510365
版权

V-rep Hexapod tutorial（2）

1.添加用户参数User Parameters
(1)给hexa_body添加Non-threaded script
在这里插入图片描述
(2)hexa_body的脚本代码中插如如下代码并运行

	function sysCall_init()
    	Base=sim.getObjectHandle('hexa_body')
    	sim.setUserParameter(Base,'@enable','')
	end

（3）点击运行
运行后在hexa_body获得如下图标，双击可打开用户参数对话框
在这里插入图片描述
（4）添加用户参数

NameValueUnit
stepVelocity0.51/s
stepAmplitude0.16m
stepHeight0.04m
movementDirection0degrees
rotationMode0-1: CCW, 1: CW, 0: no rotation
movementStrength00-1

在这里插入图片描述
2.打开动力学
在这里插入图片描述
3.设置参数
（1）设置六条腿的第二个和第三个关节的位置为0，让六个脚能搭在地面上
在这里插入图片描述
4.代码理解
（1）hexapod的脚本
线程子脚本，只运行一次，运动前机身的“热身动作”

//这个线程脚本（threaded）是六足动物的主控制脚本。它产生身体运动并进行控制
//另一个非线程脚本（non-threaded），负责生成行走运动
//另一个脚本是通过仿真参数控制的：这个脚本写入参数（sim.setScriptSimulationParamete）
//并且另一个脚本读取参数(sim.getScriptSimulationParameter)

//----------------------------函数setStepMode：设置用户参数里的六个值-----------------------//
setStepMode=function(stepVelocity,stepAmplitude,stepHeight,movementDirection,rotationMode,movementStrength)
    sim.setScriptSimulationParameter(sim.handle_tree,'stepVelocity',stepVelocity)
    sim.setScriptSimulationParameter(sim.handle_tree,'stepAmplitude',stepAmplitude)
    sim.setScriptSimulationParameter(sim.handle_tree,'stepHeight',stepHeight)
    sim.setScriptSimulationParameter(sim.handle_tree,'movementDirection',movementDirection)
    sim.setScriptSimulationParameter(sim.handle_tree,'rotationMode',rotationMode)
    sim.setScriptSimulationParameter(sim.handle_tree,'movementStrength',movementStrength)
end
//-------------------------函数moveBody：让机身在原地运动（各个方向旋转）----------------------//
moveBody=function(index)
	//获得当前的目标位置和角度（3个方向）
    local p={initialP[1],initialP[2],initialP[3]}
    local o={initialO[1],initialO[2],initialO[3]}
    //把腿部和机身移动到给定的位置和方向（实际在第一次运行时该行代码不动）
    sim.moveToPosition(legBase,antBase,p,o,vel,accel)
    //输入的索引为0：腿部不动，机身抬起h后下落h
    if (index==0) then
        //机身抬起，速度加倍
        p[3]=p[3]-0.03*sizeFactor
        sim.moveToPosition(legBase,antBase,p,o,vel*2,accel)
        //机身下落，速度加倍
        p[3]=p[3]+0.03*sizeFactor
        sim.moveToPosition(legBase,antBase,p,o,vel*2,accel)
    end
    //输入的索引为1：4次弯曲【twisting】
    if (index==1) then
        o[1]=o[1]+5*math.pi/180
        o[2]=o[2]-05*math.pi/180
        o[3]=o[3]-15*math.pi/180
        p[1]=p[1]-0.03*sizeFactor
        p[2]=p[2]+0.015*sizeFactor
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
        o[1]=o[1]-10*math.pi/180
        o[3]=o[3]+30*math.pi/180
        p[2]=p[2]-0.04*sizeFactor
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
        o[1]=o[1]+10*math.pi/180
        o[2]=o[2]+10*math.pi/180
        p[2]=p[2]+0.03*sizeFactor
        p[1]=p[1]+0.06*sizeFactor
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
        o[1]=o[1]-10*math.pi/180
        o[3]=o[3]-30*math.pi/180
        p[2]=p[2]-0.03*sizeFactor
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
    end
    //输入的索引为2：绕着x轴旋转三次：17，-34，17【rolling】
    if (index==2) then
        p[3]=p[3]-0.0*sizeFactor
        o[1]=o[1]+17*math.pi/180
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
        o[1]=o[1]-34*math.pi/180
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
        o[1]=o[1]+17*math.pi/180
        p[3]=p[3]+0.0*sizeFactor
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
    end
    //输入的索引为3：绕着y轴旋转三次：15，-30，15【pitching】
    if (index==3) then
        -- pitching
        p[3]=p[3]-0.0*sizeFactor
        o[2]=o[2]+15*math.pi/180
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
        o[2]=o[2]-30*math.pi/180
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
        o[2]=o[2]+15*math.pi/180
        p[3]=p[3]+0.0*sizeFactor
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
    end
    //输入的索引为4：绕着z轴旋转三次：30，-60，30【yawing】
    if (index==4) then
        p[3]=p[3]+0.0*sizeFactor
        o[3]=o[3]+30*math.pi/180
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
        o[3]=o[3]-60*math.pi/180
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
        o[3]=o[3]+30*math.pi/180
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
        p[3]=p[3]-0.0*sizeFactor
        sim.moveToPosition(legBase,antBase,p,o,vel,accel)
    end
end
//---------------------------------------线程子脚本的主要函数----------------------------------//
function sysCall_threadmain()
	//获得机身的目标Dummy
    antBase=sim.getObjectHandle('hexa_base')
    //获得足部的目标Dummy，hexa_legBase下包含六条腿的目标Dummy
    legBase=sim.getObjectHandle('hexa_legBase')
    //检索场景对象的大小因子。尺寸因子与真实物体的大小不同。使用此功能可以对伸缩操作做出反应。
    sizeFactor=sim.getObjectSizeFactor(antBase)
    //物体移动的速度
    vel=0.05
    //物体移动的角速度
    accel=0.05
    //物体移动的目标位置targetPosition
    initialP={0,0,0}
    //物体移动的目标角度targetOrientation
    initialO={0,0,0}
    //设置物体初始先腿不动，机身向上移动，因此只改变targetPosition的z分量（注意，此时sizeFactor为1，initialP[3]为负，机身向上移动，[1]和[2]都是正负和x、y轴的正方形对应）
    initialP[3]=initialP[3]-0.03*sizeFactor
    //将对象移动到给定的位置和方向
    sim.moveToPosition(legBase,antBase,initialP,initialO,vel,accel)
	
    stepHeight=0.02*sizeFactor
    maxWalkingStepSize=0.11*sizeFactor
    walkingVel=0.9

    //原地移动旋转
    //设置六个参数：步速(1/s)、步幅(m)、步距(m)、运动方向(degrees)、转动模式(-1: CCW, 1: CW, 0: no rotation)、运动强度(0-1)
    setStepMode(walkingVel,maxWalkingStepSize,stepHeight,0,0,0)
    moveBody(0)
    moveBody(1)
    moveBody(2)
    moveBody(3)
    moveBody(4)
    
	//保持身体固定的姿势向前走
    setStepMode(walkingVel,maxWalkingStepSize,stepHeight,0,0,1)
    //线程等待
    sim.wait(12)
    for i=1,27,1 do
        setStepMode(walkingVel,maxWalkingStepSize,stepHeight,10*i,0,1)
        sim.wait(0.5)
    end
    //停止
    setStepMode(walkingVel,maxWalkingStepSize,stepHeight,270,0,0)
    sim.wait(2)

    //向前走，同时改变身体姿势
    setStepMode(walkingVel,maxWalkingStepSize*0.5,stepHeight,0,0,1)
    moveBody(0)
    moveBody(1)
    moveBody(2)
    moveBody(3)
    moveBody(4)
    //停止
    setStepMode(walkingVel,maxWalkingStepSize*0.5,stepHeight,0,0,0)
    sim.wait(2)

    //原地旋转
    setStepMode(walkingVel,maxWalkingStepSize*0.5,stepHeight,0,1,1)
    sim.wait(24)
    -- Stop:
    setStepMode(walkingVel,maxWalkingStepSize*0.5,stepHeight,0,0,0)
end

（2）hexa_body的脚本
非线程子脚本，这个脚本负责移动腿来行走
本质上，是通过每次调用线程时，赋予p不同的位置，再赋予给不同的腿来实现

//----------------------------------非线程子脚本的初始化函数----------------------------------//
function sysCall_init() 
	//获得六条腿的目标Dummy的中心
    antBase=sim.getObjectHandle('hexa_legBase')
    //获得六条腿的尖端和目标Dummy
    legTips={-1,-1,-1,-1,-1,-1}
    legTargets={-1,-1,-1,-1,-1,-1}
    for i=1,6,1 do
        legTips[i]=sim.getObjectHandle('hexa_footTip'..i-1)
        legTargets[i]=sim.getObjectHandle('hexa_footTarget'..i-1)
    end
    //获取六条腿的尖端的位置（相对于平面中心）
    //sim.getObjectPosition(objectHandle,relativeToObjectHandle)
    //参数objectHandle：对象的句柄
    //参数relativeToObjectHandle：表示相对于我们想要的参考框架的位置。
   	 	//指定-1来获取绝对位置，指定sim.handle_parent来获取相对于对象父体的位置，或者指定相对于我们想要的参考框架的对象句柄。
    	//如果这个句柄是一个关节的句柄，那么将返回相对于该关节移动框架的位置（除非objectHandle与sim.handleflag_reljointbaseframe相结合，在这种情况下，将返回相对于该关节基本框架的位置）。
    initialPos={nil,nil,nil,nil,nil,nil}
    for i=1,6,1 do
        initialPos[i]=sim.getObjectPosition(legTips[i],antBase)
    end
    //腿部移动顺序
    legMovementIndex={1,4,2,6,3,5}
    //六个用户参数
    stepVelocity=0.5
    stepAmplitude=0.16
    stepHeight=0.04
    movementDirection=0*math.pi/180
    rotation=0
    movementStrength=1
    
    stepProgression=0    
    realMovementStrength=0       
end
//-----------------------------------非线程子脚本的恢复函数-----------------------------------//
function sysCall_cleanup() 
end 
//-----------------------------非线程子脚本的主要函数：驱动函数-----------------------------//
function sysCall_actuation() 
	//检索仿真时间步长（在每个主脚本仿真过程中所经过的仿真时间（即不是实时的））
	//这个值对于一个特定的模拟来说可能不是恒定的。
    dt=sim.getSimulationTimeStep()
    //获得六个用户参数
    stepVelocity=sim.getScriptSimulationParameter(sim.handle_self,'stepVelocity')
    stepAmplitude=sim.getScriptSimulationParameter(sim.handle_self,'stepAmplitude')
    stepHeight=sim.getScriptSimulationParameter(sim.handle_self,'stepHeight')    	
    movementDirection=math.pi*sim.getScriptSimulationParameter(sim.handle_self,'movementDirection')/180
    rotation=sim.getScriptSimulationParameter(sim.handle_self,'rotationMode')
    movementStrength=sim.getScriptSimulationParameter(sim.handle_self,'movementStrength')
	//dt为0.05，dx为目标movementStrength和实际realMovementStrength的差
    dx=movementStrength-realMovementStrength
    //如果差值大于0.05，dx=dt*0.5=0.025
    if (math.abs(dx)>dt*0.1) then
        dx=math.abs(dx)*dt*0.5/dx
    end
    //更新实际realMovementStrength
    realMovementStrength=realMovementStrength+dx
 	//对每条腿执行如下操作  
    for leg=1,6,1 do
        sp=(stepProgression+(legMovementIndex[leg]-1)/6) % 1
        offset={0,0,0}
        if (sp<(1/3)) then
            offset[1]=sp*3*stepAmplitude/2
        else
            if (sp<(1/3+1/6)) then
                s=sp-1/3
                offset[1]=stepAmplitude/2-stepAmplitude*s*6/2
                offset[3]=s*6*stepHeight
            else
                if (sp<(2/3)) then
                    s=sp-1/3-1/6
                    offset[1]=-stepAmplitude*s*6/2
                    offset[3]=(1-s*6)*stepHeight
                else
                    s=sp-2/3
                    offset[1]=-stepAmplitude*(1-s*3)/2
                end
            end
        end
        md=movementDirection+math.abs(rotation)*math.atan2(initialPos[leg][1]*rotation,-initialPos[leg][2]*rotation)
        offset2={offset[1]*math.cos(md)*realMovementStrength,offset[1]*math.sin(md)*realMovementStrength,offset[3]*realMovementStrength}
        p={initialPos[leg][1]+offset2[1],initialPos[leg][2]+offset2[2],initialPos[leg][3]+offset2[3]}
        //我们只是设定了想要的脚的位置。IK在那之后被隐式地处理(在默认的主脚本中)。你也可以用sim.handleIkGroup()来显式处理IK。
        sim.setObjectPosition(legTargets[leg],antBase,p) 
    end
    
    stepProgression=stepProgression+dt*stepVelocity
end
Angel濠梁之上
关注
  • 1
    点赞
  • 踩
  • 6
    收藏
    觉得还不错? 一键收藏
  • 2
    评论
专栏目录
V-rep Hexapod tutorial
weixin_43986879的博客
09-26 424
V-rep Hexapod tutorial 1.导入模型 （1）[Menu bar --> File --> Import --> Mesh…] （2）文件：安装位置下的hexapod.dxf （3）网格缩放和网格定向选项：直接勾选Import （4）拆分模型 导入的模型为一个整体shape，如图所示 拆分模型操作：[Menubar-Edit-Grouping/Merging-Divide selected shapes] 2.模型处理 (1)删除多余腿 六足机器人有 6 条
V-rep Hexapod tutorial（3）-- Matlab简单控制
weixin_43986879的博客
10-01 279
V-rep Hexapod tutorial（3）-- Matlab简单控制 1.Matlab联合仿真环境搭建 (1)设置Matlab端 找到安装CoppeliaSim的位置 我的位置如下： C:\Program Files\CoppeliaRobotics\CoppeliaSimEdu\programming\remoteApiBindings\matlab\matlab 把里面的全部文件拷贝到文件夹1 把reomteApi.dll导入到文件夹1 reomteApi.dll文件在v-rep的安
v-rep六足建模
10-11
对六足进行了建模，并写好了运行程序，可以根据自己的需要自行修改
高精度六轴平台（Hexapod platform）逆运动学分析（二）部分运动学分析
zhelijun的博客
11-28 1475
Hexapod可以看成是由三个如下的结构组成的，我们先提取其中一块来分析 可见Hexapod的逆运动学非常简单。
Hexapod
03-29
昆虫 这是用arduino制造的六足动物的机器人项目。 此代码是临时代码，无需硬件即可运行。 它会在将来进行更改。 EBailloux 怎么运行的 ？ 首先使用“ make”命令进行编译 执行“ hexapod”文件 输入任何运动命令 输入“结束”以退出程序 可用的移动命令： - STOP - FORWARD - BACKWARD - TURNING_RIGHT - TURNING_LEFT - OVER (to quit program) 免责声明：显示的所有电动机值均为假值和临时值。
V-rep软件仿真安装包亲测可用
10-23
2. **模型库**：V-rep内置了大量的机器人模型、传感器模型和环境模型，用户可以直接使用或作为基础进行修改，快速搭建仿真环境。 3. **脚本语言支持**：V-rep支持多种脚本语言，如Lua、Python和C++，通过编写脚本...
V-rep安装文件.txt
04-20
由于https://www.coppeliarobotics.com/网站需要翻墙才能...V-REP_PRO_EDU_V3_6_2_Ubuntu18_04，V-REP_PRO_EDU_V3_6_2_Setup，V-REP_PRO_EDU_V3_5_0_Setup，V-REP_PRO_EDU_V3_5_0_Linux，V-REP_PRO_EDU_V3_3_2_Setup
V-REP-YouBot-Demo：V-REP平台上的YouBot Control演示
02-03
V-REP-YouBot-Demo 基于V-REP平台的入门级教程及Demo，从零开始学习如何在V-REP平台上进行机器人的仿真和交互。我们定了一个小目标，完成一个Demo。使用官方提供的KUKA公司的YouBot机器人模型来实验机器人的感知和...
资料_V-rep_
10-01
2. **控制器编程**：使用V-rep的脚本语言编写控制逻辑，实现小车的移动、转向等功能。这可能涉及到速度控制、转向角度计算等。 3. **传感器模拟**：为了实现自动寻路和避障，可能需要用到虚拟传感器，如激光雷达或...
hexapod-parts
07-02
六足零件 这些是的 STL 文件。 它们不适合任何目的，除非可能作为如何不制造机器人的案例研究。
hexapod-robot:我的毕业工作项目
06-21
#六足机器人项目 我的毕业作品项目库。 请忽略！！！
hexapod:基于 Python 和 Raspberry Pi 的 WIP-A 六足机器人
07-14
注意：该项目正在进行中。 关于 该项目基于 Python 和 ，这是一款信用卡大小的计算机，具有 GPIO、USB、10/100 以太网等功能。 它是一个 6 腿（六足）机器人，每条腿有 3 个自由度。 目前，它可以使用记忆技术通过优化的步行算法线性行走，通过 PS3 控制器进行控制，流式传输视频，通过 flite TTS 引擎和板载扬声器进行通话，使用超声波传感器执行基本对象检测，使用卸载的硬件中断ATmega328P，使用预测性物体检测算法（目前正在重写）通过相机检测纯色物体，并从 BMA180 传感器收集加速度数据。 其他动作、所有功能的集成等正在进行中。 硬件 1 个 1 x 4GB 或更大的 SD 卡 1 x 用于连接家庭网络的低功耗 USB wifi 模块 1 x 低功耗 USB 蓝牙模块，用于连接 PS3 控制器 2 x 用于控制伺服 PWM 信号。 这是基于 ，它有自己的内
Hexapod开源项目启动
javabones的专栏
03-16 275
最近看了一些六足机器人的视频感觉很有意思，我决定也自己动手开发一个玩玩。 目前这个项目命名《Hexapod》，并规划为以下几个课题： 1、多路舵机控制； 2、机器人骨架； 3、基于蓝牙通信的Android上位机； 4、2.4G无线视频通信； 5、机器人主控，实现平衡、避让等脱机功能； ...
V-rep机器人仿真软件使用的学习笔记
热门推荐
DoctorSRn的博客
08-13 1万+
这篇博客主要是记录自己学习和使用机器人仿真软件V-rep过程中的一些知识点和踩的坑。
sim函数仿真，遇到这个问题怎么解决，搜了很多也没解决，有无好心人帮帮忙？
wqarhfggha的博客
04-26 92
报错：原函数如下：
V-rep仿真：Python获取激光雷达数据
培培哥的专栏
03-10 7330
这几天打算使用Vrep机器人仿真平台做实验，但却在获取激光雷达测量数据的过程中遇到了困难：机器人所使用的雷达由两个vision sensor组成，但Vrep的remoteAPI没有接口可以直接获取传感器的深度数据，更没有接口直接得到雷达的测量数据。琢磨了几天，终于解决了这个困难，以下是我使用python获取Vrep场景内激光雷达测量数据的操作步骤。 一、在Scene中添加一个激光...
transform.Translate与Rigidbody.AddForce与Velocity与MoveToPosition方法的不同
weixin_51002263的博客
11-14 1921
Velocity的默认坐标是世界坐标 1.transform.Translate(Vector3SpeedTime.deltaTime,Space.World);//以米每秒为单位,坐标轴，不受力的影响 2.Rigidbody.AddForce(Vector3*系数);//受力的影响 3.Velocity = (Vector3*Speed) ;//一直都是固定的速度 4.MoveToPosition;//类似闪现 1，2不可以实现相类似的效果。 2，3不可以实现相类似的效果。 2，4不可以实现相类似的效果。
VREP——无人机路径规划（按键控制、目标跟踪、DQN）
weixin_40820983的博客
06-12 6727
2020.06.12更新 1、键盘控制无人机运动并保存图像、位置信息（Python） code：待审核 （莫名其妙的，最近上传资源审核都不通过。如果不能下载，留言） 功能: 1、键盘 w s a d up down left right 八个按键控制无人机 向前 向后 向左 向右 上升 下降 左旋 右旋 \ 2、记录与行人的距离、动作序号、图像 3、有前置摄像、下置摄像两个场景 2、前置摄像opencv行人识别 代码：https://download.csdn.net/downloa.
1.5 VREP之仿生机器人
剑雨巍巍的博客
12-01 492
说明 本章只是看tutorial的一些要点记录，比较零碎，仅作个人笔记之用，有所叨扰，敬请原谅！ 记录 shift+select可对场景中物体进行框式选择 三角形编辑模式式为了便于观察，可切换PAGE SELECTOR 提取形状，添加关节，位置修改，根据关节朝向与世界坐标系的关系，姿态修改,即 All joints are in position now, however, only the...
v-rep user manual
最新发布
08-13
V-REP用户手册是指V-REP仿真软件的用户指南，该软件是一款功能强大的机器人仿真平台。V-REP用户手册提供了关于如何使用V-REP软件的详细指导和说明。用户手册分为多个章节，涵盖了V-REP软件的各个方面。 首先，V-REP用户手册介绍了软件的安装和启动过程，包括了适用于不同操作系统的操作说明。然后，手册详细介绍了软件界面的各个组件和功能，如场景层次结构、物体和模型管理、相机设置等。对于初学者来说，这些内容对于了解软件的基本操作非常有帮助。 此外，V-REP用户手册还提供了关于物理引擎的说明，解释了如何设置和模拟不同类型的物理对象。手册还介绍了如何添加传感器、控制器和动作规划算法，以实现更复杂的仿真任务。手册还提供了关于远程API接口的说明，这使得用户可以通过编程来控制和监控仿真实验。 除了基本功能的介绍，V-REP用户手册还包含了一些高级功能的使用教程，如路径规划、机器人学习和视觉传感器。用户手册还提供了一些常见问题和故障排除的解决方案，以帮助用户解决在使用软件过程中遇到的问题。 总之，V-REP用户手册是一本全面指导用户如何使用V-REP软件的重要参考资料，可以帮助用户快速上手并实现各种机器人仿真任务。无论是对于学生、研究人员还是工程师来说，V-REP用户手册都是一本不可或缺的工具书。
评论 2
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值