ROS2机器狗平台中，开源做得很好的平台。
注意：
main 18.04
devel 20.04
其中，devel使用ros2 galactic！非常赞！
Xiaomi CyberDog ROS 2 License
CyberDogDog
English
简介 本项目包含小米铁蛋®的ROS 2主要功能包.
基本信息 铁蛋默认用户是mi, 密码为123 使用USB线连接Download接口, 可通过ssh mi@192.168.55.1连接铁蛋进行内部操作 软件架构 我们基于ROS 2实现了大部分的机器人应用, 如架构图所示, 包括多设备链接、多模态感知、多模态人机交互、自主决策、空间定位、导航和目标追踪等功能. 目前使用的DDS中间件是Cyclone DDS, ROS 2的版本为Galactic.
由于NVIDIA对Jetson系列截至目前(202109)只提供了Ubuntu 18.04的支持, 故我们对Ubuntu 18.04进行了ROS 2的适配和修改. 具体的修改内容可以通过mini.repos进行拉取, 我们去除了部分没必要的仓, 并添加了一些需要使用的仓库.
本项目的详细文档都在各个子模块的根目录里, 如有需要可以直接点击进行了解
前置条件 如在目标设备上直接编译, 需要保证已连接互联网. 首选环境是铁蛋, 次选环境是Docker开发环境.
如是前者，需要保证执行如下指令：
apt-get update apt-get install nvidia-l4t-jetson-multimedia-api cuda-compiler-10-2 如是后者, 可以考虑使用arm64的Docker. 我们在未来会支持交叉编译。
大陆地区加速 如果您在，可以使用我们提供的Docker的构建加速和colcon的编译加速
构建Docker时, 可使用docker build -t arm_docker:1.0 . --build-arg gfw=1进行构建镜像, 以提高速度.
使用colcon编译包时, 可在colcon编译的语句最后添加--cmake-args -DBUILD_INSIDE_GFW=ON以获取加速, 如colcon build --merge-install --packages-select sdl2_vendor lcm_vendor mpg123_vendor toml11_vendor --cmake-args -DBUILD_INSIDE_GFW=ON.
构建 & 部署 本项目支持两种构建策略:
最小功能包: 只编译影响整机启动和运动的相关功能包. 基础功能包: 编译本仓(cyberdog_ros2)的全部功能包. 最小功能包 编译方法:
下载cyberdog_ros2. mkdir -p ros_apps/src cd ros_apps/src git clone https://github.com/MiRoboticsLab/cyberdog_ros2.git cd .. 使用--packages-up-to编译(确保source过ROS 2的环境变量)
export OUTPUT_DIR=/opt/ros2/cyberdog colcon build --merge-install --install-base
下载cyberdog_ros2. Download cyberdog_ros2. mkdir -p ros_apps/src cd ros_apps/src git clone https://github.com/MiRoboticsLab/cyberdog_ros2.git cd .. 直接编译所有的包(确保source过ROS 2的环境变量)
export OUTPUT_DIR=/opt/ros2/cyberdog colcon build --merge-install --install-base
通用的部署方式 如果使用的是/opt/ros2/cyberdog路径进行编译, 且环境是铁蛋, 重启机器或服务即可部署完毕.
重启服务的方式:
To restart the service:
$ sudo systemctl restart cyberdog_ros2.service 相关项目 CyberDog_Ctrl:使用GRPC控制铁蛋 相关资源 CyberDogAPP下载链接 铁蛋躯干Step文件 向铁蛋贡献力量！ 浏览页面CONTRIBUTING.md了解如何向铁蛋贡献力量！
内核部分：
github.com/MiRoboticsLab/cyberdog_tegra_kernel
Tegra Linux Kernel for CyberDog
[简介] 本项目为L4T的内核代码项目(适用于小米定制的英伟达应用板)。目前版本为Jetpack 4.5，内核版本为4.9.201。
[编译方法] cd到内核代码所在目录后并执行以下命令：
git clone https://github.com/MiRoboticsLab/cyberdog_tegra_kernel.git cd cyberdog_tegra_kernel/kernel/kernel-4.9 ./build.sh
build.sh中make的jobs数量(-jn)可根据个人电脑实际情况进行修改。
github.com/MiRoboticsLab/cyberdog_motor_sdk
电机和惯导部分：
CYBERDOG MOTOR SDK 此SDK开放了电机驱动器和机身IMU传感器接口，配合cyberdog 1.0.0.94及以上版本使用，方便用户进行运动控制的二次开发。具体接口使用可参照Example_MotorCtrl.cpp，按如下步骤在实际机器人上部署运行。
准备工作 安装依赖 安装lcm(本地部署时需要)
git clone https://github.com/lcm-proj/lcm.git cd lcm mkdir build && cd build
按照链接所附步骤进行安装：https://docs.docker.com/engine/install/ubuntu/
# 给docker设置root权限： sudo groupadd docker sudo usermod -aG docker
wget https://cdn.cnbj2m.fds.api.mi-img.com/os-temp/loco/loco_arm64_20220118.tar docker load --input loco_arm64_20220118.tar
ping 192.168.55.100 #本地PC被分配的ip ssh mi@192.168.55.1 #登录nx应用板 ,密码123 mi@lubuntu:~ athena_version -v #核对当前版本>=1.0.0.94
$ ssh root@192.168.55.233 #登录运动控制板 root@TinaLinux:~# cd /robot root@TinaLinux:~# ./initialize.sh #拷贝出厂代码到可读写的开发区（/mnt/UDISK/robot-software），切换到开发者模式，仅需执行一次 root@TinaLinux:~# vi /mnt/UDISK/robot-software/config/user_code_ctrl_mode.txt #切换mode:1(0:默认模式，1用户代码控制电机模式),重启机器人生效 编译及部署 1、用户电脑侧部署 运行在用户pc侧(linux)难以保证实时lcm通信，仅推荐编译验证和简单的位控测试
ping 192.168.55.233 #通过type c线连接Cyberdog的Download接口后，确认通信正常 ifconfig | grep -B 1 192.168.55.100 | grep "flags"| cut -d ':' -f1 #获取该ip对应网络设备，一般为usb0 sudo ifconfig usb0 multicast #usb0替换为上文获取的168.55.100对应网络设备,并配为多播 sudo route add -net 224.0.0.0 netmask 240.0.0.0 dev usb0 #添加路由表，usb0对应替换 mkdir build && cd build #进入sdk代码仓后 make -j4 ./Example_MotorCtrl 注：lcm通信若不成功，无法正常激活电机控制模式，log提示：Motor control mode has not been activated successfully
2、铁蛋NX应用板部署 因非实时系统，仅推荐编译验证和简单位控测试
scp -r {sdk_path}/cyberdog_motor_sdk mi@192.168.55.1:/home/mi/ #sdk源码拷入应用板，密码123 ssh mi@192.168.55.1 #登录应用板 mi@lubuntu:~ cd /home/mi/cyberdog_motor_sdk mi@lubuntu:~ mkdir build && cd build mi@lubuntu:~ cmake .. mi@lubuntu:~ make -j2 mi@lubuntu:~ ping 192.168.55.233 #测试和运控板的通信 mi@lubuntu:~ ./Example_MotorCtrl 3、铁蛋运控板交叉编译部署 为了能使编译的文件可以直接在机器人上运行，需要在部署交叉编译工具链的docker镜像环境下编译，具体步骤如下：
$ docker run -it --rm --name cyberdog_motor_sdk -v /home/xxx/{sdk_path}:/work/build_farm/workspace/cyberdog cr.d.xiaomi.net/athena/athena_cheetah_arm64:2.0 /bin/bash [root:/work] # cd /work/build_farm/workspace/cyberdog/ #进入docker系统的代码仓 [root:/work/build_farm/workspace/cyberdog] # mkdir onboard-build && cd onboard-build [root:/work/build_farm/workspace/cyberdog] # cmake -DCMAKE_TOOLCHAIN_FILE=/usr/xcc/aarch64-openwrt-linux-gnu/Toolchain.cmake .. [root:/work/build_farm/workspace/cyberdog] # make -j4 #指定交叉编译工具链并编译 [root:/work/build_farm/workspace/cyberdog] # exit 编译成功后, 将生成的.so文件libcyber_dog_sdk.so和可执行文件Example_MotorCtrl拷贝到运控/mnt/UDISK目录下
cd ~/{sdk_path}/onboard-build ssh root@192.168.55.233 "mkdir /mnt/UDISK/cyberdog_motor_sdk" #在运控板内创建文件夹 scp libcyber_dog_motor_sdk.so Example_MotorCtrl root@192.168.55.233:/mnt/UDISK/cyberdog_motor_sdk ssh root@192.168.55.233 root@TinaLinux:~# cd /mnt/UDISK/cyberdog_motor_sdk root@TinaLinux:~# export LD_LIBRARY_PATH=/mnt/UDISK/cyberdog_motor_sdk #设置so库路径变量 root@TinaLinux:~# ./Example_MotorCtrl #通过“nohup ./Example_MotorCtrl &”可后台运行，退出ssh连接不受影响 如何添加开机自启动: 配置/mnt/UDISK/manager_config/fork_para_conf_lists.json 进程管理文件(注意结尾逗号)后重启运控程序 例： "600003": {"fork_config":{"name": "Example_MotorCtrl", "object_path": "/cyberdog_motor_sdk/", "log_path": "", "paraValues": ["", "", ""] }} 注：手动关闭程序时，请先关闭用户程序Example_MotorCtrl，触发主程序(ctrl)超时保护趴下，再关闭或重启主程序。同时关闭主程序和用户程序，电机会因CAN总线超时位置锁定，再次启动易发生危险。
错误标志位含义 //bit0: warning flag, lost communication between user code and robot over 10[ms]. For safety, commanded tau and qd_des will be forced to divide by (over_time[ms]/10.0); //bit1: error flag, lost communication between user code and robot over 500[ms]. Robot will enter high-damping mode by setting joint gains kp=0, kd=10, tau=0; //bit2: warning flag, position command of any abaduction joint changing more than 8 degrees from its previous will be truncated; //bit3: warning flag, position command of any hip joint changing more than 10 degrees from its previous will be truncated; //bit4: warning flag, position command of any knee joint changing more than 12 degrees from its previous will be truncated; 注：为了避免通信超时导致危险，报err_flag: 0x02 communicate lost over 500ms后先排除故障,关闭Example_MotorCtrl例程进程,再重启运控程序或者直接重启运控板才能清除错误.
# 重启运控程序: ssh root@192.168.55.233 "ps | grep -E 'Example_MotorCtrl' | grep -v grep | awk '{print ssh root@192.168.55.233 "ps | grep -E 'manager|ctrl|imu_online' | grep -v grep | awk '{print ssh root@192.168.55.233 "export LD_LIBRARY_PATH=/mnt/UDISK/robot-software/build;/mnt/UDISK/manager /mnt/UDISK/ >> /mnt/UDISK/manager_log/manager.log 2>&1 &" # 重启运控板系统:
