E-puck2-webots下的仿真实现

2023-10-11 04:59
文章标签 实现 仿真 webots puck2

本文主要是介绍E-puck2-webots下的仿真实现,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

Webots是专业的移动机器人仿真软件包。它提供了快速的原型制作环境,使用户可以创建具有物理特性(例如质量,关节,摩擦系数等)的3D虚拟世界。用户可以添加简单的被动对象或称为移动机器人的主动对象。这些机器人可以具有不同的移动方案(轮式机器人,有腿机器人或飞行机器人)。此外,它们可能配备有许多传感器和执行器设备,例如距离传感器,驱动轮,摄像机,马达,触摸传感器,发射器,接收器等。最后,用户可以对每个机器人进行单独编程以表现出所需的行为。Webots包含大量机器人模型和控制器程序示例,以帮助用户入门。

Webots还包含许多与真实移动机器人的接口,因此,一旦您模拟的机器人表现出预期的行为,您就可以将其控制程序转移到诸如e-puck,DARwIn-OP,Nao等真实机器人上。可以添加新接口通过相关系统。
在这里插入图片描述

什么是世界?

Webots中的世界是对机器人及其环境的属性的3D描述。它包含对每个对象的描述:位置,方向,几何形状,外观(如颜色或亮度),物理属性,对象类型等。世界组织为层次结构,其中对象可以包含其他对象(例如VRML97)。例如,一个机器人可以包含两个轮子,一个距离传感器和一个关节,该关节本身包含一个摄像头等。世界文件不包含机器人的控制器代码;它仅指定每个机器人所需的控制器名称。世界保存在“ .wbt”文件中。“ .wbt”文件存储在每个Webots项目的“ worlds”子目录中。
在这里插入图片描述
在这里插入图片描述

什么是控制器?

控制器是控制世界文件中指定的机器人的计算机程序。可以使用Webots支持的任何编程语言编写控制器:C,C ++,Java,Python或MATLAB。当模拟开始时,Webots将启动指定的控制器,每个控制器都是一个单独的进程,并将控制器进程与模拟的机器人相关联。请注意,多个机器人可以使用相同的控制器代码,但是将为每个机器人启动一个不同的过程。

一些编程语言需要编译(C和C ++),其他语言需要解释(Python和MATLAB),而另一些则需要同时进行编译和解释(Java)。例如,C和C ++控制器被编译为平台相关的二进制可执行文件(例如Windows下的“ .exe”)。Python和MATLAB控制器由相应的运行时系统(必须安装)解释。Java控制器需要编译为字节码(“ .class”文件或“ .jar”),然后由Java虚拟机进行解释。

每个控制器的源文件和二进制文件一起存储在控制器目录中。控制器目录放置在每个Webots项目的“ controllers”子目录中。

在这里插入图片描述

/** Copyright 1996-2019 Cyberbotics Ltd.** Licensed under the Apache License, Version 2.0 (the "License");* you may not use this file except in compliance with the License.* You may obtain a copy of the License at**     http://www.apache.org/licenses/LICENSE-2.0** Unless required by applicable law or agreed to in writing, software* distributed under the License is distributed on an "AS IS" BASIS,* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.* See the License for the specific language governing permissions and* limitations under the License.*/#include <stdio.h>
#include <string.h>#include <webots/accelerometer.h>
#include <webots/camera.h>
#include <webots/distance_sensor.h>
#include <webots/light_sensor.h>
#include <webots/motor.h>
#include <webots/position_sensor.h>
#include <webots/robot.h>#define WHEEL_RADIUS 0.02
#define AXLE_LENGTH 0.052
#define RANGE (1024 / 2)static void compute_odometry(WbDeviceTag left_position_sensor, WbDeviceTag right_position_sensor) {double l = wb_position_sensor_get_value(left_position_sensor);double r = wb_position_sensor_get_value(right_position_sensor);double dl = l * WHEEL_RADIUS;         // distance covered by left wheel in meterdouble dr = r * WHEEL_RADIUS;         // distance covered by right wheel in meterdouble da = (dr - dl) / AXLE_LENGTH;  // delta orientationprintf("estimated distance covered by left wheel: %g m.\n", dl);printf("estimated distance covered by right wheel: %g m.\n", dr);printf("estimated change of orientation: %g rad.\n", da);
}int main(int argc, char *argv[]) {/* define variables */WbDeviceTag distance_sensor[8], left_motor, right_motor, left_position_sensor, right_position_sensor;int i, j;double speed[2];double sensors_value[8];double braitenberg_coefficients[8][2] = {{0.942, -0.22}, {0.63, -0.1}, {0.5, -0.06},  {-0.06, -0.06},{-0.06, -0.06}, {-0.06, 0.5}, {-0.19, 0.63}, {-0.13, 0.942}};int time_step;int camera_time_step;/* initialize Webots */wb_robot_init();if (strcmp(wb_robot_get_model(), "GCtronic e-puck2") == 0) {printf("e-puck2 robot\n");time_step = 64;camera_time_step = 64;} else {  // original e-puckprintf("e-puck robot\n");time_step = 256;camera_time_step = 1024;}/* get and enable the camera and accelerometer */WbDeviceTag camera = wb_robot_get_device("camera");wb_camera_enable(camera, camera_time_step);WbDeviceTag accelerometer = wb_robot_get_device("accelerometer");wb_accelerometer_enable(accelerometer, time_step);/* get a handler to the motors and set target position to infinity (speed control). */left_motor = wb_robot_get_device("left wheel motor");right_motor = wb_robot_get_device("right wheel motor");wb_motor_set_position(left_motor, INFINITY);wb_motor_set_position(right_motor, INFINITY);wb_motor_set_velocity(left_motor, 0.0);wb_motor_set_velocity(right_motor, 0.0);/* get a handler to the position sensors and enable them. */left_position_sensor = wb_robot_get_device("left wheel sensor");right_position_sensor = wb_robot_get_device("right wheel sensor");wb_position_sensor_enable(left_position_sensor, time_step);wb_position_sensor_enable(right_position_sensor, time_step);for (i = 0; i < 8; i++) {char device_name[4];/* get distance sensors */sprintf(device_name, "ps%d", i);distance_sensor[i] = wb_robot_get_device(device_name);wb_distance_sensor_enable(distance_sensor[i], time_step);}/* main loop */while (wb_robot_step(time_step) != -1) {/* get sensors values */for (i = 0; i < 8; i++)sensors_value[i] = wb_distance_sensor_get_value(distance_sensor[i]);const double *a = wb_accelerometer_get_values(accelerometer);printf("accelerometer values = %0.2f %0.2f %0.2f\n", a[0], a[1], a[2]);/* compute odometry and speed values*/compute_odometry(left_position_sensor, right_position_sensor);for (i = 0; i < 2; i++) {speed[i] = 0.0;for (j = 0; j < 8; j++)speed[i] += braitenberg_coefficients[j][i] * (1.0 - (sensors_value[j] / RANGE));}/* set speed values */wb_motor_set_velocity(left_motor, speed[0]);wb_motor_set_velocity(right_motor, speed[1]);}wb_robot_cleanup();return 0;
}

这篇关于E-puck2-webots下的仿真实现的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/185691

相关文章

hdu1043(八数码问题,广搜 + hash(实现状态压缩) )

利用康拓展开将一个排列映射成一个自然数,然后就变成了普通的广搜题。 #include<iostream>#include<algorithm>#include<string>#include<stack>#include<queue>#include<map>#include<stdio.h>#include<stdlib.h>#include<ctype.h>#inclu

【C++】_list常用方法解析及模拟实现

相信自己的力量,只要对自己始终保持信心,尽自己最大努力去完成任何事,就算事情最终结果是失败了,努力了也不留遗憾。💓💓💓 目录   ✨说在前面 🍋知识点一:什么是list? •🌰1.list的定义 •🌰2.list的基本特性 •🌰3.常用接口介绍 🍋知识点二:list常用接口 •🌰1.默认成员函数 🔥构造函数(⭐) 🔥析构函数 •🌰2.list对象

【Prometheus】PromQL向量匹配实现不同标签的向量数据进行运算

✨✨ 欢迎大家来到景天科技苑✨✨ 🎈🎈 养成好习惯,先赞后看哦~🎈🎈 🏆 作者简介:景天科技苑 🏆《头衔》:大厂架构师,华为云开发者社区专家博主,阿里云开发者社区专家博主,CSDN全栈领域优质创作者,掘金优秀博主,51CTO博客专家等。 🏆《博客》:Python全栈,前后端开发,小程序开发,人工智能,js逆向,App逆向,网络系统安全,数据分析,Django,fastapi

让树莓派智能语音助手实现定时提醒功能

最初的时候是想直接在rasa 的chatbot上实现,因为rasa本身是带有remindschedule模块的。不过经过一番折腾后,忽然发现,chatbot上实现的定时,语音助手不一定会有响应。因为,我目前语音助手的代码设置了长时间无应答会结束对话,这样一来,chatbot定时提醒的触发就不会被语音助手获悉。那怎么让语音助手也具有定时提醒功能呢? 我最后选择的方法是用threading.Time

Android实现任意版本设置默认的锁屏壁纸和桌面壁纸(两张壁纸可不一致)

客户有些需求需要设置默认壁纸和锁屏壁纸  在默认情况下 这两个壁纸是相同的  如果需要默认的锁屏壁纸和桌面壁纸不一样 需要额外修改 Android13实现 替换默认桌面壁纸: 将图片文件替换frameworks/base/core/res/res/drawable-nodpi/default_wallpaper.*  (注意不能是bmp格式) 替换默认锁屏壁纸: 将图片资源放入vendo

C#实战|大乐透选号器[6]:实现实时显示已选择的红蓝球数量

哈喽,你好啊,我是雷工。 关于大乐透选号器在前面已经记录了5篇笔记,这是第6篇; 接下来实现实时显示当前选中红球数量,蓝球数量; 以下为练习笔记。 01 效果演示 当选择和取消选择红球或蓝球时,在对应的位置显示实时已选择的红球、蓝球的数量; 02 标签名称 分别设置Label标签名称为:lblRedCount、lblBlueCount

Kubernetes PodSecurityPolicy:PSP能实现的5种主要安全策略

Kubernetes PodSecurityPolicy:PSP能实现的5种主要安全策略 1. 特权模式限制2. 宿主机资源隔离3. 用户和组管理4. 权限提升控制5. SELinux配置 💖The Begin💖点点关注,收藏不迷路💖 Kubernetes的PodSecurityPolicy(PSP)是一个关键的安全特性,它在Pod创建之前实施安全策略,确保P

工厂ERP管理系统实现源码(JAVA)

工厂进销存管理系统是一个集采购管理、仓库管理、生产管理和销售管理于一体的综合解决方案。该系统旨在帮助企业优化流程、提高效率、降低成本,并实时掌握各环节的运营状况。 在采购管理方面,系统能够处理采购订单、供应商管理和采购入库等流程,确保采购过程的透明和高效。仓库管理方面,实现库存的精准管理,包括入库、出库、盘点等操作,确保库存数据的准确性和实时性。 生产管理模块则涵盖了生产计划制定、物料需求计划、

基于UE5和ROS2的激光雷达+深度RGBD相机小车的仿真指南(五):Blender锥桶建模

前言 本系列教程旨在使用UE5配置一个具备激光雷达+深度摄像机的仿真小车,并使用通过跨平台的方式进行ROS2和UE5仿真的通讯,达到小车自主导航的目的。本教程默认有ROS2导航及其gazebo仿真相关方面基础,Nav2相关的学习教程可以参考本人的其他博客Nav2代价地图实现和原理–Nav2源码解读之CostMap2D(上)-CSDN博客往期教程: 第一期:基于UE5和ROS2的激光雷达+深度RG

C++——stack、queue的实现及deque的介绍

目录 1.stack与queue的实现 1.1stack的实现  1.2 queue的实现 2.重温vector、list、stack、queue的介绍 2.1 STL标准库中stack和queue的底层结构  3.deque的简单介绍 3.1为什么选择deque作为stack和queue的底层默认容器  3.2 STL中对stack与queue的模拟实现 ①stack模拟实现