Simulator on Unity + PhysX communicating with ROS
- 本シミュレータは自律施工技術開発基盤OPERA（Open Platform for Earth work with Robotics and Autonomy）の一部であり、どなたでも利用可能です
- シミュレータプラットフォームにUnity、物理エンジンにNvidia PhysXを利用しています
- Unityを利用するため、利用者が所属する組織に応じたUnityのライセンスが必要です。詳細はUnityの公式サイトをご確認の上、利用登録をしてください。
使用しているPCのOSに応じて以下の通りUnityHubをインストールする
- windows 又は Macの場合: https://unity3d.com/jp/get-unity/download
- Linuxの場合(Linux版は動作確認していない):https://unity3d.com/get-unity/download
- UnityHubを起動し、画面右上の「追加」から
OperaSim_PhysX(Githubから自身のPCにダウンロードしたもの)選択し、クリックする（初回起動時には数分程度の時間がかかります）。クリックした際に指定のUnity Editorを選択しダウンロードする。
- デモ用のサンプルSceneファイルが
Asset/Scenes/SampleScene.unityにあるので、これを開く.
- UnityEditorの上部ツールバーからRobotics > ROS Settingを開き"ROS IP Address", "ROS Port"のところにROS側のIPアドレスおよびポート番号(defaultは10000)を入力する
- もしROS2を利用する場合は"Protocol"のところを"ROS1"->"ROS2"へ変更する
- 【初回のみ】ROS側でROS-TCP-Endpointパッケージをcloneし、buildとセットアップを行う。
ROS 1 の場合
$ cd (rosワークスペース)/src $ git clone https://github.com/Unity-Technologies/ROS-TCP-Endpoint.git $ cd ./ROS-TCP-Endpoint/ $ sudo chmod +x setup.py $ ./setup.py $ catkin build ros_tcp_endpoint $ source ../../devel/setup.bash
ROS 2 の場合
$ cd (ros2ワークスペース)/src
$ git clone -b main-ros2 https://github.com/Unity-Technologies/ROS-TCP-Endpoint.git
$ cd ./ROS-TCP-Endpoint/
$ sudo chmod +x setup.py
$ ./setup.py
$ cd ../../
$ colcon build --packages-select ros_tcp_endpoint
$ . install/setup.bash- ROS側でendpoint.launchを実行する
$ roslaunch ros_tcp_endpoint endpoint.launch
- Unity Editor上部の実行ボタンをクリックする
- ROS側で、対応する建機のunity用launch ファイルを起動する
- 油圧ショベル
$ roslaunch zx120_unity zx120_standby.launch
- クローラダンプ
$ roslaunch ic120_unity ic120_standby.launch
- Cmd (ROS -> Unity)
| データの内容 | トピック名 | トピック型 | 物理量 | 単位 | 備考 |
|---|---|---|---|---|---|
| 建機の移動体部に対する対地速度指令値 | /(建機のns)/tracks/cmd_vel | geometry_msgs/Twist | 速度 | [m/s],[rad/s] | |
| ダンプトラックの荷台の傾斜角指令値 | /(建機のns)/vessel/cmd | std_msgs/Float64 | 角度 | [rad] | |
| 建機のスイング軸の角度指令値 | /(建機のns)/swing/cmd | std_msgs/Float64 | 角度 | [rad] | |
| 建機のブーム軸の角度指令値 | /(建機のns)/boom/cmd | std_msgs/Float64 | 角度 | [rad] | |
| 建機のアーム軸の角度指令値 | /(建機のns)/arm/cmd | std_msgs/Float64 | 角度 | [rad] | |
| 建機のバケット軸の角度指令値 | /(建機のns)/bucket/cmd | std_msgs/Float64 | 角度 | [rad] |
- Res（Unity -> ROS）
| データの内容 | トピック名 | トピック型 | 物理量 | 単位 | 備考 |
|---|---|---|---|---|---|
| 建機のベースリンクの座標 | /(建機のns) /base_link/pose | geometry_msgs/PoseStamped | 位置・姿勢 | 位置:[m] 姿勢:[-] | Unity内のworld座標系に対する座標の真値 |
| 建機のオドメトリ計算結果 | /(建機のns) /odom | nav_msgs/Odometry | オドメトリ | 位置:[m] 姿勢:[-] | 初期位置を原点として算出している |
| 建機の関節角度・角速度 | /(建機のns) /joint_states | sensor_msgs/JointState | 角度・角速度 | 角度:[rad] 角速度:[rad/s] | effortについては次節を参照 |
各ゲームオブジェクトに設定されたJoint State PublisherスクリプトのEnable Joint Effort Sensorをチェックすることで、joint_statesトピックからeffort値を出力させることができます。
Note 関節トルクセンサは実機では利用できないことが多いのでご注意ください。
各関節の制御パラメータは、ゲームオブジェクトのXDriveパラメータを変更することで可能です。
| プロパティ名 | 説明 |
|---|---|
| Lower Limit | 関節可動角の下限（単位はdegree）。可動角制限を有効にするには、Motionプロパティを「Limited」に設定してください |
| Upper Limit | 関節可動角の上限（単位はdegree）。可動角制限を有効にするには、Motionプロパティを「Limited」に設定してください |
| Stiffness | 関節の剛性係数。係数の意味は下の式を参照。0の場合はデフォルト値20000を使用します |
| Damping | 関節の減衰係数。係数の意味は下の式を参照。0の場合はデフォルト値10000を使用します |
| Force Limit | 制御中に加えられるトルクの最大値（単位はnewton）。0の場合はデフォルト値10000を使用します |
Stiffness（剛性）とDamping（減衰）の各係数は、下の式に用いられます。
加えられるトルク = 剛性係数 * (駆動位置 - ターゲット位置) - 減衰係数 * (駆動速度 - ターゲット速度)
上記、各パラメータの詳しい説明は、Unityの公式マニュアルも参照ください。
https://docs.unity3d.com/ja/2023.2/Manual/class-ArticulationBody.html#joint-drive-properties
長いリンクのある多関節の重機をシミュレーションする際に、関節制御が振動的になることがあります。 この症状は、以下の調整を行うことで軽減できます。
メニューから Edit > Project Settings... を選択し Physics 項目を選択します。
Default Solver Iterations プロパティの数値を大きな値に変更してください。
土砂の粒子シミュレーションのパラメータは、TerrainゲームオブジェクトのSoil Particle Settingで変更できます。
| プロパティ名 | 説明 |
|---|---|
| Enable | 土砂の粒子シミュレーションをオフにしたい時には、このチェックボックスのチェックを外してください。 |
| Particle Visual Radius | 粒子の見た目上の半径を設定します。粒子同士が干渉する半径を設定するには、下のRockPrefabの設定も合わせて調整してください。 |
| Particle Stick Distance | 近くの粒子との間に引力を働かせることで、土砂の粘性を再現できます。引力を発生させる範囲を設定します。 |
| Stick Force | 近くの粒子との間に発生させる引力の強さを設定します。 |
粒子が周囲の粒子と干渉する半径を調整するには、RockPrefabのSphere ColliderのRadius値を変更してください。
