From 78b5a5159770f8304c972a3b0eed93cbd63fff77 Mon Sep 17 00:00:00 2001
From: YusukeKato <YusukeKato@users.noreply.github.com>
Date: Fri, 17 Nov 2023 11:11:15 +0900
Subject: [PATCH] =?UTF-8?q?=E3=83=A9=E3=82=A4=E3=83=B3=E3=83=88=E3=83=AC?=
 =?UTF-8?q?=E3=83=BC=E3=82=B9=E7=94=A8=E3=81=AE=E3=82=B3=E3=83=BC=E3=82=B9?=
 =?UTF-8?q?=E3=82=92=E4=BD=9C=E6=88=90=20(#74)?=
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

* ライントレース用のコースを作成

* コースを地面より0.01浮かせる

* 動作周期を修正

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>

* ラズパイマウスの初期位置を指定する引数を追加

* ラズパイマウスの初期位置をlaunchファイルから指定できるように変更

* モデル作成者の名前を変更

* blenderのモデルの作成者を変更

* コースモデルの大きさを修正

* コースモデルのスケールを修正

* コースモデルの作成者名を変更

* パネルの寸法が分かる名称に変更

* ワールド名を柔軟なものに変更

* 線の幅を4cmに変更

* READMEにモデル一覧を追加

---------

Co-authored-by: Shota Aoki <s.aoki@rt-net.jp>
---
 README.en.md                                  |  23 ++++
 README.md                                     |  25 ++++
 .../raspimouse_with_emptyworld.launch.py      |  18 +++
 ...pimouse_with_line_follower_field.launch.py |  51 ++++++++
 .../meshes/course_curve.jpg                   | Bin 0 -> 13806 bytes
 .../meshes/course_curve_50x50cm.dae           | 115 ++++++++++++++++++
 .../models/course_curve_50x50cm/model.config  |  16 +++
 .../models/course_curve_50x50cm/model.sdf     |  34 ++++++
 .../meshes/course_straight.jpg                | Bin 0 -> 5959 bytes
 .../meshes/course_straight_50x50cm.dae        | 115 ++++++++++++++++++
 .../course_straight_50x50cm/model.config      |  16 +++
 .../models/course_straight_50x50cm/model.sdf  |  34 ++++++
 .../worlds/line_follower_field1.sdf           |  76 ++++++++++++
 13 files changed, 523 insertions(+)
 create mode 100644 raspimouse_gazebo/launch/raspimouse_with_line_follower_field.launch.py
 create mode 100644 raspimouse_gazebo/models/course_curve_50x50cm/meshes/course_curve.jpg
 create mode 100644 raspimouse_gazebo/models/course_curve_50x50cm/meshes/course_curve_50x50cm.dae
 create mode 100644 raspimouse_gazebo/models/course_curve_50x50cm/model.config
 create mode 100644 raspimouse_gazebo/models/course_curve_50x50cm/model.sdf
 create mode 100644 raspimouse_gazebo/models/course_straight_50x50cm/meshes/course_straight.jpg
 create mode 100644 raspimouse_gazebo/models/course_straight_50x50cm/meshes/course_straight_50x50cm.dae
 create mode 100644 raspimouse_gazebo/models/course_straight_50x50cm/model.config
 create mode 100644 raspimouse_gazebo/models/course_straight_50x50cm/model.sdf
 create mode 100644 raspimouse_gazebo/worlds/line_follower_field1.sdf

diff --git a/README.en.md b/README.en.md
index 768d839..61bc52e 100644
--- a/README.en.md
+++ b/README.en.md
@@ -93,6 +93,29 @@ ros2 launch raspimouse_ros2_examples object_tracking.launch.py mouse:=false use_
 
 ![](https://rt-net.github.io/images/raspberry-pi-mouse/raspimouse_sim_object_tracking.gif)
 
+## Model data list
+
+### course_curve_50x50cm
+Curve course panel for line following.
+Panel size is 50 cm x 50 cm and line width is 4 cm.
+
+![](./raspimouse_gazebo/models/course_curve_50x50cm/meshes/course_curve.jpg)
+
+### course_straight_50x50cm
+Straight course panel for line following.
+Panel size is 50 cm x 50 cm and line width is 4 cm.
+
+![](./raspimouse_gazebo/models/course_straight_50x50cm/meshes/course_straight.jpg)
+
+### cube_*cm_color-name
+Each cube is 5 cm, 7.5 cm, 10 cm, and 15 cm on a side.
+The cube colors are red, yellow, blue, and green.
+
+![](https://rt-net.github.io/images/raspberry-pi-mouse/color_objects.png)
+
+### daeファイルについて
+The dae file is edited in Blender 4.0.
+
 ## License
 
 This repository is licensed under the MIT license, see [LICENSE]( ./LICENSE ).  
diff --git a/README.md b/README.md
index a8a9bc7..740803d 100644
--- a/README.md
+++ b/README.md
@@ -93,6 +93,31 @@ ros2 launch raspimouse_ros2_examples object_tracking.launch.py mouse:=false use_
 
 ![](https://rt-net.github.io/images/raspberry-pi-mouse/raspimouse_sim_object_tracking.gif)
 
+## モデルデータ一覧
+
+### course_curve_50x50cm
+
+ライントレース用の曲線コースパネルです。
+パネルサイズは50cm x 50cm、線の幅は4cmです。
+
+![](./raspimouse_gazebo/models/course_curve_50x50cm/meshes/course_curve.jpg)
+
+### course_straight_50x50cm
+
+ライントレース用の直線コースパネルです。
+パネルサイズは50cm x 50cm、線の幅は4cmです。
+
+![](./raspimouse_gazebo/models/course_straight_50x50cm/meshes/course_straight.jpg)
+
+### cube_*cm_color-name
+それぞれ一辺5cm、7.5cm、10cm、15cmの立方体です。
+色は赤、黄、青、緑です。
+
+![](https://rt-net.github.io/images/raspberry-pi-mouse/color_objects.png)
+
+### daeファイルについて
+daeファイルはBlender 4.0で編集しています。
+
 ## ライセンス
 
 このリポジトリはMITライセンスに基づいて公開されています。  
diff --git a/raspimouse_gazebo/launch/raspimouse_with_emptyworld.launch.py b/raspimouse_gazebo/launch/raspimouse_with_emptyworld.launch.py
index 3fd7629..f0aa8eb 100644
--- a/raspimouse_gazebo/launch/raspimouse_with_emptyworld.launch.py
+++ b/raspimouse_gazebo/launch/raspimouse_with_emptyworld.launch.py
@@ -50,6 +50,18 @@ def generate_launch_description():
         'world_name',
         default_value=get_package_share_directory('raspimouse_gazebo')+'/worlds/empty_world.sdf',
         description='Set world name.')
+    declare_arg_spawn_x = DeclareLaunchArgument(
+        'spawn_x',
+        default_value='0.0',
+        description='Set initial position x.')
+    declare_arg_spawn_y = DeclareLaunchArgument(
+        'spawn_y',
+        default_value='0.0',
+        description='Set initial position y.')
+    declare_arg_spawn_z = DeclareLaunchArgument(
+        'spawn_z',
+        default_value='0.02',
+        description='Set initial position z.')
 
     env = {'IGN_GAZEBO_SYSTEM_PLUGIN_PATH': os.environ['LD_LIBRARY_PATH'],
            'IGN_GAZEBO_RESOURCE_PATH': os.path.dirname(
@@ -71,6 +83,9 @@ def generate_launch_description():
         output='screen',
         arguments=['-topic', '/robot_description',
                    '-name', 'raspimouse',
+                   '-x', LaunchConfiguration('spawn_x'),
+                   '-y', LaunchConfiguration('spawn_y'),
+                   '-z', LaunchConfiguration('spawn_z'),
                    '-allow_renaming', 'true'],
     )
 
@@ -140,6 +155,9 @@ def generate_launch_description():
         declare_arg_lidar_frame,
         declare_arg_use_rgb_camera,
         declare_arg_world_name,
+        declare_arg_spawn_x,
+        declare_arg_spawn_y,
+        declare_arg_spawn_z,
         ign_gazebo,
         ignition_spawn_entity,
         robot_state_publisher,
diff --git a/raspimouse_gazebo/launch/raspimouse_with_line_follower_field.launch.py b/raspimouse_gazebo/launch/raspimouse_with_line_follower_field.launch.py
new file mode 100644
index 0000000..dae194a
--- /dev/null
+++ b/raspimouse_gazebo/launch/raspimouse_with_line_follower_field.launch.py
@@ -0,0 +1,51 @@
+# The MIT License (MIT)
+#
+# Copyright 2023 RT Corporation <support@rt-net.jp>
+#
+# Permission is hereby granted, free of charge, to any person obtaining a copy of
+# this software and associated documentation files (the "Software"), to deal in
+# the Software without restriction, including without limitation the rights to
+# use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
+# the Software, and to permit persons to whom the Software is furnished to do so,
+# subject to the following conditions:
+#
+# The above copyright notice and this permission notice shall be included in all
+# copies or substantial portions of the Software.
+#
+# THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+# IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
+# FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
+# COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
+# IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
+# CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
+
+import os
+
+from ament_index_python.packages import get_package_share_directory
+from launch import LaunchDescription
+from launch.actions import IncludeLaunchDescription
+from launch_ros.actions import SetParameter
+from launch.launch_description_sources import PythonLaunchDescriptionSource
+
+
+def generate_launch_description():
+    world_file = os.path.join(
+        get_package_share_directory('raspimouse_gazebo'),
+        'worlds',
+        'line_follower_field1.sdf')
+    world_launch = IncludeLaunchDescription(
+        PythonLaunchDescriptionSource([
+            get_package_share_directory('raspimouse_gazebo'),
+            '/launch/raspimouse_with_emptyworld.launch.py']),
+        launch_arguments={
+            'world_name': world_file,
+            'spawn_x': '0.0',
+            'spawn_y': '0.0',
+            'spawn_z': '0.02'
+            }.items()
+    )
+
+    return LaunchDescription([
+        SetParameter(name='use_sim_time', value=True),
+        world_launch
+    ])
diff --git a/raspimouse_gazebo/models/course_curve_50x50cm/meshes/course_curve.jpg b/raspimouse_gazebo/models/course_curve_50x50cm/meshes/course_curve.jpg
new file mode 100644
index 0000000000000000000000000000000000000000..69ded420d9384d75195061086f0919b7971941a2
GIT binary patch
literal 13806
zcmeHt`B#(I*8iilTD4UX1S<l!*n)s)V;EF~*h=8GB+}dvP#{o20|W>%gfL@YYh^T-
zYY`Hr8fqd>Bor}*5JIfXL!cN!ln_wnDIh}#5E9<ld%r)tYgPV%?>$*7!-2K;=ks~a
zu=m+#^X2AiVE?zS-?#$XwgJF4?F-nH0v7<C?eE&VcO7l}V8;jV+DAKfe7IxRN4t0L
z`e@g#-5>A!c=w*Ydv@*mME8@u`}XhG-M{<e19}Jc>uJC5-+Tt_`ABC{XL8#%U0|~j
zFwt7xuCwi31OC%K+O=cn?hkc7*uG8sclds-Z=DaeZT~<=XV;Dobw1RB*{<`!hdXxa
zestioU3!qO^v$lELj7>?=;vSmBP#cPmBAO#!07)mw7n42aLDd?%uU*_zi;*fAH6dV
z1K3~wKPUhF{I3H4Rp7r0{8xehD)9fc0^70)sqP~ccgg-27l%|aUsV$vS>p`wWfQ$X
zjT=Mlmz?dUrkaPuf&9YJU{e{rK$-0n*NhE#UTEhH)qIjxyzuo~(stfG!NTL{Fpd-A
zlC=Lp6m%W48j08hl06U({;Pu3w6dlc#^}6Lbm+S4j@$ak0NHBRJ%KPgV6`v41Ca(F
zsrTT*R0W4qOs6O(jT}b8p08{Is<ge4zMBAVVyKa=$?JU^tvT)MdS?^R8R@D_bRKey
z^5JOiStXEC&s<vW_DT-qdZr2MhD(=!&wF^|{f|_~FS61s-Y`4TuW58|(5u?L*jjUL
zgRn1ZvW*%vZ;%pjs`3q@tX{eLWHpLygG{s^AMmYL*d^k+GVaT0fk`t0ui#c%kRp?@
zEWfYJZ&qGl=SH`fzBP%vM)p`r@af{Y+C_QK1d5rtkWFCjN$SjMYXX|(%O`W5V6&c1
zvVzC3jW6Z{1cXu!F@TS)rNh!X($$B9h#OxgcMZm~1M!;kbH@{{?$BeYkmcG<;8y%S
zImYz4Pd;%`X+7V84oZ$rl@EA<>pje{gfp?-Z+Te6IbbJd3(jkl^bAS~?Xbt)jkblP
zbbM>eke}>nRdv(}ICDMK05SdPQ)Wpmy)HR~8%KVWDu$S-yB{B0^k`=M^yC{}R@1;0
zE(fC`nWwk*R`$PG2xF*X5y>;vrVqR(OXuMAF00QHFg&vrXCWhOwg}H6;l_*U&HfnM
zG#rl-6D>opi}0nQU$2dx{G#s0SbTeRYqF5XuJap8dg-9>?R|q;ceR5WgpywzOAp(x
z4e-S0-^=BkJjmyT{Yqi(qnUNO3579?ayWHr>0}R1NIg1(Axa=f$a*KO@<cK!*>$+K
z^8443e#P_Umka1oaZk@(lPcFehQq+@#B#MJD-V%6YBLs@v+u;r5@~08{K)zK)9j}9
zqfj)@znr4j$Uk<c;uXg!Noa?Pb1Z$NnBRBCtv&Ly1jd4XH0jGZY?z_>(ebGz%IVdE
zM5jj0fo@u($BaH{SuMQy4*uDP?<28ofg2~wwBknBhSCbCAQ=2Go&2b?%+NmB?c6`!
z9BTbtIC|K@i%o_irhI*<#64A>m?@B22}h9$V6XsVC(A4=->7zOHR>Gt)IV5;&ZS>(
z?(A8yKbTs3th=+IS7E{rxL2DJD+(OwObG#HUGx;Ngje9!RwV2=(ont$SVxmTn~|29
zQKz|hyCc(c{Z)1;f#UK~_`^-$US=q{=f^*xzn{S&w_`Co4X!uea?Jl(IiB;>Rs*gP
zCq_kZ(lp(?oF)_`&U^PF)@?)>w4?_}=pKPRu}x^}*+_V4$k_phVD!V1Zi=&RA9VAl
zRt)#R&dQ<28krZ)-1%-lKcTW?6ENGj1*-2LN9Aa!JKs}$*!~ODZ3fDtQjCO>@s_j+
zM!zLE!4ibbm6yid`xET@2hAsz-6jF?>XB=iQ=^*m4OL8}fD-)m@0z^w!Hi6L$s^P}
zfy#&KM$h&{*35`^_f2d9+1|(J-MMEiwnxmSWIPZ<5qRzssZdN14G?Wbp2#fYmMGhG
zg4kGzj5?;rBeCX(5@m8BUwN^jhL~KC&MO9Se(eH3w-@HTyLLp=kokwIbJ~HeZSRNq
zN6CeR@)2crjpR|Z$r2~G5-z|N^B%y@_~Z?a)FyHC^j~F=A9&+wl$m~9N?z1xa8p)k
z0^wBbUK{d;y_A#UrS?gg;xPkgN#ySQ-ei`VZYH$FAe1Jx_jkoqN3+j$tgWq)qN5+P
z#EEK^#GIE;z(DQ1G3a>=8VZFvFP+->{!fhW9lF~XbvG6nKPHFvSa^?NM}qd98UtBZ
zCRh0Zz14~H57~hh_4J@hYz(rdga;n<809pPi_Qeb*h_T#D|4PUwXr1KP5dRhY-Wns
zSaMfamn?IpEWb);QE5Trl8??%@^ee?COJaQ=3J4gJS;y^9)l%WgGnF=mL^cNP5Yku
zpA7E3IyQ3k{<XRZq_5QbD@KcDj0l<GUPo?zA*lx;?(IauofUqp#FB?JbCA(*cFo)5
zAIaY<PrNST-yhjaA)ObgF+P>C({aZt?Kj|9QV!W0%(CrtW0RaPofwrpcq?+wxT%sL
z46=?QRK$GONA#Q45WG@TkqMs~&P*Q_W825^U}E~6@!-kDXa5!xAb$6sFaP&LX9DA?
z#e_lWH<F-G`TidUFKu|8=KM6>^(xusqRA#8Tfs3MPL*?^Wm8Hgn9p1f<P658lLQB8
zrTrOPq^Hp8U*rCyG4kIWFi9=<lqGT8Vi_t2KjvQ)ZcQZ0>XK{~aB7;3Qxn9b{LVCm
z$t{llHv;FHRplZ}6m(eFA+ahcr^%ogw7Tb$Tb#OxMWeV8bTNC?;-AEDpNWU94bsc`
z5gzJgDK$;__~}psL+B(X5T=rMR=lJi<!b)X-YA;bI7N__z7g5=)a&`<@p(;Wct#gq
z9G&+fylw=Ksx)xY7e&L#2FYc7xZx>M_o1NmGA@mHZXIMSm;AQA3G7O`1pA<#$c1b?
z=t$bzn4*E7$xrJO?@QbBI*CtkNjsMCA?;GBpzRNWY!mS9<tGK`ATrC=HUSG86l^j4
z6;mB^KkRS+SKI&m>aG7O0n#vdN}eG*QeIneMG_}#|IPMM0)4!!T;hi9AqUk^`PvnW
zON|iOp=ZE?lHNCCoW`34b@`PJ_(>9LwjRdCc#XLIE`X(XvmugY=|b;7hO#uzgFaN}
z(iDU6O8>X3?v<U}Vn|lftc|Ef9w$0zeOPwcCyt!D;&jmCg*6`uJ3;<cBStNMW1R6e
zcgcu^(W{WFxz!a&h@W4df=LvjU?GgXC&hZ}7~S>de<oSKPV?&_-)*f^=}U%|vz_!V
z%pKKaXGwxKW;x?st6!}qJdNCthh3COAD7Uby{amNwT|jd;E%~F*tpE-!gHAJiW9kE
z(%&h(Fn0jq*Sp+qXI&+k<K{0}li%2Ie~HN9vcC*+?^h)udfrZzjF@^fa>#g?oMr}V
zo4)avVgefTz;p^FJzYu3OG(IE@P6fo^hz_)&NZ*S^MeNT@T=1b58;d0enEx45Nevq
zGrd?|nvdw_V~}>fo^GElx~j$^#1wvlDRJ8IwqF+uFQ61B5-^e&2wYcXFBc6o*-xg^
z3RdW5P6fZcgYa?n_X`1EEYk1CxQ}3esBv(`)MW6&z7a)ULxQ+KCycNbcZ|U$C)WO0
zGqUeT!@Q)yV;zH~v*Qg73e+?M-JSiY_91f+PwPAG$EZ<>u<aJy8KuIeM)aEdj2Fi|
z<40*VVkBJc=N?2Bg>W8Rk(H_Jq>OQYjqTtAtD2F9Zo^etp<THD-u{AwL*k~6GnCVi
zVhZ8mI`YgJ*s0~T-O_*lwNk*gpQ1^YvwIC+t?`t1N&Y4`Y2S<17Ej?z=Dd45eK{^9
zj5LqvgmOWmB~L6%h5It{KU>rLRJtd}QuwNln40<MYEa@710|MsKhao?=|SLJa%3){
zoF0f*h@;KT3S9n_N0f6qGB1IQDK^ZCS7BwJdLkilwgXmk(yD_VD2z1MB+F9?Sz}Uz
z6v#o-Rmc)<I_oSM5{c9c9QHOA-^?&=rz}8V)t)Gfz2zLN0@=T=X}=z2`h338-wJFd
z_%{pqY)3nIRDNwV%+M_*spU;MT^l;h4}o$q3`9@Xn&doPu8Y_gId#a#zwowOM@z%=
zDtMMb=)3@FFquv-m<#UzZ1O!40ozX}M2&9(daL>OF=5xQiYn%hbSCg0$cx;2J~gBz
zWfF#%<=IKj4+|7xJv*W|jXF-H9aFVNevuH|CL1&A$g^v0XPQ`Z7@;qp2p<{Si_v<R
zLo4)P(U9jl2;y0lNN12CGR9xm0@yj()YL9)WoO(bN2^uhCW8uJ8lF{4Ps|L}4rhw$
zYyaz!&%4_RS6E#SYU1Q9#~$kf>SNAv?_eu11$7W!XB8NkNVBNPs=`y!)enBWPJZs&
zeBuPd$aCn@+D2~0t4usNUgg~;8Xm<AU|fyMr$Y;-&9lUV8A`R<rTq_k%}sV}c7%Yv
zjQGUV{dw8g$oH><P-Jpo$#{ybFU^b^#HCD|IamJuePV43NR3VQu%F+HDvt`*3BD3m
zxH2HgC}z5#({_H%H4%$UeIiFiPAz4FnO5ZPX)2y=E3f5T933*sg2m0rVjM2_5#6hE
zDaD0}OitxM!MfN})&0c9CB@9l%<2B{JGZTI7k?idxLb2P;v%fy=jlk_sX$zx0VTs9
zK1FwCBW+ze(Yo_?9w^;;=>FgQfmLYq-eIPx&*D+i%l=DH2qw`yD|!%D=1GFsN^;k#
zX1lQnq$#XFW%!G$ex}2bWQ}8xPg&OK5u}K{+h&7DZCVeu_y=DGL885oT{Cp687?h@
zerG(9e)Lt%`(yxi4tI4lzgRdqF+TdLxv80hnUTzU>-(|^1#{XcA*GydW{wN)H#=xE
zk=A62l6kXF7%!Av;@<kD5t9YZNe?1F{d8#=?9*2vnXpj4ins}&MTkU}SBTc*$ED;|
zY1(4_Xw{R`(hxk4e5p-YrsvTN%A-6|ki^a;lnZGdi`H-H!x^}Zr2Sq7wJO4Pj1JBe
z`B*IvYy!C0J-y->xpPr=7rj8$D8gCIS=8|M92*`q8Xi0#?UnmmzU;r)FG@Sv$+;D1
zHnv_q4_0DJ=KNV^I45r_kX1kX^1Z}O3}$7#m@9IjTYRKVjNadSVwnf8j!#@0$clR;
z)n*UfZ{Ot*jczfJ-5yH~!xpv4xxJ5TW^ztd+nPX{SRvp5Da^tjq^$7nO8EAHLAA$I
zU==a7d|T;{H?&TdSLUPxMgpHkX_EJa?moM4RaLOwP8}28n&F(s3#v_z9tOSca-7t>
z?<Re6AU23FWX|s3#cZ$1`Z=Q5Ty6-RYeDy3y_y;p=cI;C(oSF?P(2KIKg7?w;hgVt
zUqa4<CPyQ8sn0d29=6Ugpeq1$oaRaJ6mDWYqY~2&GAjw|xMx}*f88J^?xPhs4JvE&
z=tcOz>HZTpf9+p;b;f%<Rq$;Htzbhu04CC@mKk7qL3&1>{u*=Q;wG@z9V?-~thD%Q
zM0jdLTqa-TioJ1;>Fu4=U}pZf^Uq3KpNwVE!1|nD*7sVs6piJ^m)z=Bt0)J5B|Eo8
zYOb~&EOY#>iPGK8v0X1O^7ElnmN9xB-UOsA(G%m=IUVZTO-{ACPR>sJ!pH5Pe9via
ze#J(eFzh6Ay(BjEase+j&_X1$?e3sia`cRwAW)lUf6eb*@9%5D`Syl8XKmd7b>^fW
z`#}g5Yb?Q{WE~QVmE-+oGtpycV>BWqwZ2CWa-rnvTA?7hW^fa@)63-l8m_jIr?vW~
zW)=4Ymd39s=}xSx7*n76pBsg?3S%LvRck-IYuCb1e)1hz?vvAHp`-ZxNop|kROR?@
zzu9!BbzKc8?I4`ZtR*Lc(}7fc>9xlA{I|cqnKvzeE>mf;Bh>Zs#FOZJ3RyERA~cd9
zS!C}hEXq^m&(rgc6=7`qOWxSMpWBXo9Yx%#(-*Gbi}KnI%lIc<UR10zS;4$~mdEU6
zwp$-BubXY#BAM@X>HIFgz$9RP6R;tv6Z@($a)+?ceCx9Fe;nh<9=W6CODBl(XmykX
z6sSU{3)0=5X;*iZF4W0|bgEQyWW&l~;-vKV(Y*;9al%)e@~qYVYqm{?pEBH1MN^=~
z+oz1d6ilPU(<Lz^9W2a^EQ)N}NNY55(+i3!c_CVv%eXxsske8CZdLg(gBx8w$ILgk
zBxBmgL2zd9+P@RczhwEb+ubuquPy9o6?0Ah$(}jvdXx6DaP6`~@X(Cd7KKQXM1yoo
zdioq53^a4h+m%2WzqqnElzQ<&vEgz>aoGSXN9V#?u_!QOrBGSBQfXGBE>~s-EsErN
zc5Z(IfE@u%8<^H}J$2Wg?)x;tPnhJ}#as*;K^yy))o5{YrwhHN<{Vkv%pgI6-^5R_
zk4qdE`s((cA8r4QQ))IML8=VZdS1o9`jHcZ4P;Sz(X$?cZmuo_g6KhVGpO{*za;f%
z=Q(2;&wlW^)aTyf;Mr#TyR@l8;;{+bsAP(R6YCC$p_+F)0z_92y8k};?73c<iBDvI
z)!P%-LW>f983OG!WY2Y++<&=?fN)V@)`xLsPQzloNyZ?-JNksy!{@;nCi@q=?<Fei
zB4&M_U<+^O8W6F<d|a?eXA2s`)K{9O3#JN6;ZR)<uoUYFM?vH3&&7)x>%R=|UUA4=
zwrpmYg>WBEU&g=(<lo965M+X3;8C%Jm>5d8q?Ka)sX<~V`MW6KJuUV4Y+c031DaF<
zvMAgyjOfo#RYbvgUQ>6bL2Z&q4K%~yQfQyKZ34O{&k;|4;egbf8hNz75a04u+qBFR
zA@btiby2J`t5&KJ%EgLq=~}zMR)nniyVhT6$*$y64yF#?jOfy{SAr*xr1+upZZb&r
zQ1-OBBQ0pXFA7{KrO2_dn?S>~Ro0V%5>bCrSYU(<77{MsxyQA~mI)!>x_KLC<5NX&
z?iHEV<8Z+<+H`%Ov*Xo!2x+^weYXkdr#Z6bD%`(YD7&qw$=SJ^Tg4;#`IfA$>37$E
zSX(xQ%OFqSV1%0GBs4tWRP{3eND05h&yCAEw8G@Y$x(29lr}xZAQZZ~rk5!yo14!B
zw;mK9wynRmNOI*QIR|F*EpVg03RI4gHg_MP!o*BL$jc1rILRB78T|Bqa6qLXLsG1N
zy-V8mI@MZY#Ssu^FXi|;9+>d9J#O@~T08o)3!ik4%`Bnd0nkOE7fAKhQko2*npbg&
z*)}}RlSh0H&)!ODQ^WJdYK(NvkO^ASWVPB200gxeO8Okm`@(BjgD?EGd;F0q;pu|J
zmZM19q36#s=qu(!lsh9LPZDyVKqb2~MN6sZR4iGQyna94kA}vT_i9ZuijYYGwDA+T
zMTsRh<7q5UOfr0Ic2t}jT~I)&##zz9+8HqvZY;8ELY+^ljGZ%9aP6E%c*Nu!v`^nD
z7H(qvDn{0!WHM{PQchoLZm&y{i_3)u?E+T8Ug>%>m~_*lztF?2Lrm13<(#g$bm<;_
zOsd3}l+&p}Gq5Rzzv+#keKP*ACMWox4(cLgz+Huro?*0QIycCLjdjA1b70?aAy8yT
zkK)cG19U?Bb-$k!aHX!I-4XUvyvlb}t_0CP+@Cxx%FT_DN}`jdv%H42A&E6BltxWe
zVD?YkY)ku$lz+Fb3XG;NWJXQ5r8kLUXGrEeAHpYkp8YMf@^l4JJ6phMCyWG(bz?ph
zYdtGgnqLkWbzh&7qVXZG&a$eQS5X<aZe<a|c&YLjv8@P^vI&T0tc7onKFi?`cMWpt
zIC<Gf-@EMa)N1Ha=DjC{7`OTpwwg_V-BC5~sd5`z?>zs0N;?;z`YxTFE^c+54~K@Y
zjQ^OR*BaF<)xogS?yL|n0k>PL0>Ht_hfPp;XZ=V&GqwpMWlN%Lg+wJJ`p=|l--Qc3
z#2n$H@8xm<{Te=z&d80_+q2I=>>YVEfa{5d*B+yr<3W(Fjhe@=CBXI#ZF@pKWUt_>
zTTj>2<{!hqTriwN+sfFqODv~_aEx)2x49DwOAb|MT4+P4m~-z34|ofjd^;0Y3$J;Q
z2NIZ=$aunrhgap@z%+ZxuM!y)fl>Q%*1>{xq5W{J;JBFZ;N%TJXC|;|HtWfy7B*JO
z!Dk+$W#Y6CL3^H@zTVmWiYWLba@*u<<lz?E#jd+9i}qDHkRNU(rc<P=`Igh6)2S2(
zOG@U%3><1d!kSBD{F!vW2Vw6ZGT}pZUGN)OWFE=RizT^Dh+3|2<_(?TyQ5gtdRIHW
z-tKWKPAd(rFxIcKJo8#t_tC|@(_<0JibeaCUS^lXVQ)m|Y=;8TnK)gFKbApRmeNX*
z`Y4m$9;9u{lM4m_@ZsYPo8&z?W?jXj^Uz7i8RbKU1#arhJ#8@8>%l*p*KV;1{3B?v
z(_^-AV~~#~fHoh$2k*P?<Y|y<sXbpeE4VYRUBUIC3x8W2to(fK4qqp9nk^eq=VLpK
zO>71-*rmBc-b-o$-nt+&qO)@oaDdyn(Fxuk{SN@_Qoe0{dvU^H?i?X@%;_+7Re4@}
zK25rERhq%@@8ZC|p{0c#7Nge2(`<+>9UDD{frS-YVESP9YDGfOxid{quGe>nQ?)g>
zmts+Vv@mu<2y>eY;rXejz>TK3kP-pzWGB)NjVS*T01ljdZhF9O-sTLhd5{|Yc7>3I
zspAX5{yX%pbDir^axuiVNi|3<FRLj<z=;Y^6vSzp+?c_MGk+zrC;ZW~uv}s2+RV9q
z^A_2|^HQ}75eZS2_Tg~2q<5#PN$1~>S4VfW%e8;to8O3o-wyU?Uzy~Qc8?RVZ3PO9
zzD8K9O<XV%PZ3;St(_EsPGemG=VF{^CN!4^{Hp6B(=KYm9&XrSYX$07j>lMa4k3};
zK^Q<IJWzH-JCAV?N7M$U9jlBi4jCG4kkRbB$DIlDlROSGG8sZoa*Rn>>0Mpt!dTQn
zZ%hC_loIPU0wX&@oA;W(SgphfFYAvW#_&El9Z_(Z``H@$iBWF^Vm)bDgtS#UQ;*R~
zCPV}B@83@j@C<I=*M63>W9;{Zn<3K&H9B9h`WUs=Y%I!f3122AXE_lMq6wM9W2kvO
zY)9I+71qZ9AgxLd+Upi$-M)HtHOTu;9m(4~Qf)R4Gn+r|lbVvXoJa^g94oYwHd2EJ
z3)w>30iIrOW0O9@MM?n)H{Op%=eq=CcfUo>kuPev9$tlp(F?~lhHed9?|__MR%25Z
z#JI7OBqJ*34desN*$IcJxle+Kgik!Q`;6;&D)Z5}e=qbgOEDwJP2{r1+G|(dWyHai
zgNxc}bz{SF<4jqB!@!c{Z=tsSuXqk8EJct?k#mlR7u^g@5mew?VkO?GVsHB??GU!i
zV!R(Gu<h@gfC21_iF@37$$ok9w*>heJ8;}?6Ud9k4f<CFpziu9yfMiInc?Vx#Bx^A
z9R~P^cHs-}Hm-rjB^Y<q8tTapn`f<8%zNRk_DpkrxaG#*psI(@((bI^84-JmT$03l
zv*R0bo|f*9(%fwJHT2jpxXrmf+0e*wLK0m_c7CitGb=7O216A0CW2tO>hV@fS4gDY
zxu2RAN?YW=w|YhPGq9~?Yu1EUmE~)-dF%KrVq)+LO$NbEm(3%=vY9U@VxT9F!pv9V
zaPWcbLZuZiQPDqMJLm1G#9%PaOWM%uKc$lG%bG*}pSO?)9JR@&Y(2PrC~3XvQ70Jb
zlg^`0Y4<F0h8~Pc1v9cZL5tlWcnox8AE5rSg|f#~!)>F;bL?)xDwd-#EquD#cOq1g
zT&tpKDgpwsD*ID3ej@lCx+9(Gow!oI0{}kgTD=ngU=!#ywL|fh{)I^S-4;nW{?jM^
zG-}1fM5pjl&0VCwxJRZJJxYX3(vC4J3lWteTVUAn^P;MxDmh|7NnA|!tKO&xGJ1RV
zU?Cr4$aYls1Uf+>GxQ7!4-0YH;CY{2KhxDEZ0}t<IWaLNYin=kVP=%`e$+WE*RxZM
z#dz>Bh|bPVRcFV-4Zz8X%^_9{)x^rmpDxe5T7O!dAFQ+UfY50`kQ-M+lj*n2Q^9o2
ziJWB5h4~8$cYl1k2^^fV^Wjr+A{P?7A_Vj}Mx0sXU`9a(H7T8TXQYNh81RTO=4`<R
z*o|LpO3=}~T5QgJMm34Rg!&#3o~f;{?QC)&`V~fDY&%n|)-EYfVwAHufQL{$=V_-)
zL9%i36%Lo=T0S}`7Y)~a!j0xzg!gFUJYFfr^u?(_$N4oTMg)gKAa?#>U?9^yehUoS
zZZ7S#nDm1*6*BT1Yy#%g)pY+}YtBrjl>lq2-D?6V%!i5ruB|UaP=RSY^JuV8;5Wn*
z_ztQHtryNdebal&4l&asKRCpXX6ALe^*doaP%GqMZH=~VRYK-iSkJ2k&8iD}3ul{$
zyV=@`xYK%I?eugQD`*N1kzp_^bV_OUul1h}^SRIce4oabh5Arqh3p?(jcdnCk=}Dj
z;y5*Gg*DdC<a+xLf)kav@GaPEe_RjUm^thGM}Nt=$yZgMI{weR>MIrso`N|Pho?d!
zFdqKP1AIg4^~T0wkwT8T0c?Mv`B>x7>`LH|_KiKuDAOAcaSR?uZvy2Q$Z97wN!=^7
z4+WhVl2qpo>=vH?x@^vEUfcu<@r!#}iznLdJtp|SSb|RIxn_cuqKn03-7u3-dgV(+
zkBc8zkiMa`E`8MD4gjZ&Z$2jN{CqxQCwYZ+<XV^!8Py{CvZ8Z6v{1s#w4^eokPzsA
z*ttg+>iox)+wIdF!dr%cyu_-%H;ot9R~ornmP*!2=f;;R++xI}6BulJt%e;fys-s-
zcz3$e4)eUklF&JOysf2=gVAL#m(%f?v^k6&e0mBjO~jWSF3Ox@O2Kl*{Ff7x0B{-h
zd+81QfZwf}bLoA*O&1wI!1E0+upSm<vX5k?y|AVSraoPmSw?t7sZUtU?D=5}_W;_X
z*_$##TymAYsc?WwZdNT1H3#>=wZKur%&=vN#|vC`;&BW@9W)^^k#!UM0YEi8aus*A
zzoDTDD^<?W#h^{2Si9&t!6CW|Z7FE##lDQX&vHftWYvYNV^#R#3m(5`=LC)k5F7Gu
zmp3}8^x8nDC_^i%C1ox}A7!lAKd=?RbMoLzqPUgZ;>wxJ_ZDo`4u|J({_wWxEPHKv
zPJ%_Rq|?oVRYlz~4qr?sw{#eBerAX8F1k*L7m0`1(E`7hY;27Eqek_xOaRwiM}7P`
zunppDkZg3WVaz$VMsXyx(q*LfXv{SX#1rj>sU0q|j`DOvd3RF@jUFi55y_s>t<br6
zWS+DUH~AkWAdVcTKAQF&R2Nrd*tVnzhccOMbI!e8cFbkc3Ux|7eE<LqDR1-N92(vP
z4n3N$K<_v{<42~PZE6Q;Ai=dXl6NU?+@e3UV2v|XK#p%)@8+PlIG_NwT?{z9*Nb^Q
zdair;xbLz!>q%^);#?~yF>Q&$Zt?VX6V)Dn$;LpP)mJ@4f<!G1T(Vs=wGy((>K&FD
zl$Tk@Ouy_8$7Y&8tRjp>8J@)G&QEdNK(5*{AK{yH{)Ij3CL<z6a5Hj`d(Xo0*WZu$
zQkGw~uw77u0TR>+jfCh9s7ngAP-ovbPJ8m6m>v^6=5VaVE<v~TNO9zeqDM|)eyzpM
zvuNA(-)ubE8dpjMZ{$81>cG^TZvmjn^rq=PQ7yMRI>w+Z2OiHea?eH_rsK?^OMFkb
zr<x%mN19W}oURAaueb31iRrkvg}7nxWb{Q9heFbGFm&PHVhpiOOZo_Y&Gt^QEgPIj
zl(!NMb?%CK27I`>aq@H~%W6R{d~7^W5{w>HvgV3vSY{SIX`+h`XvMPjK^|=M7_1c}
z`rg>WuQhoD-KIyoKG;4y>#K|ylKIGG?q<hIJN!?4!lGwx0^jiR0w1a)QZr)!;94@~
zH{xFOsF2y*k9o<?ueB?3GLyZ^phh57z0$%wqS`0098CLrKC;$?{2)STs6&{Hk9)f;
zKWWfsVB%D-HVF5n9pk{A)HG_~QB}!Sz_yc9zdVv<#A_c~aWpbhT#_C=-ymXLX0BMa
z3l3fzV3qbo47JdMH-X5?#~<GSEG(Yy%Nj{aKx_K1y#k}`O|tUJMV?ZHFVkwn)dsYh
zpK{KUu+T97Syk$4-T5sP*(N;suYsFKn4|m5qKzwDW1{T%EyZa&lxgf+hG5y@qsv*g
z(scD_kIn;zc5nSgE=%k7)UKVhHc>n(o~UfLqkv~=b0(h%khN3VT6T9pJ3Vdk(pK|A
z$1mYvePvXsPPF#AL=z8Q$KM$~eWoVHPk|T}kptT3Y4sB{SQh0qu<eD#?YbBb{dhrh
zlEI^-nzchoNk$f@gss!e1PWxeh>C-`OIR2Fb3x*-DSmdliIF7jFF6u+)+Pq)KuTrP
zC-33zs50pDBUba3PkL_qc_<Z1)R%yc^J}M@kw35Tt}F=G2^yoQIUCr;c2MRFK5XHp
zW=4AJDz!H%rZs!1TRp}P{Wc;w_mDaJGFMlc)>B<^{)|UszVl1)xR7dmQ-Dmok*?WY
z3;@V|KmOEMNlM81b*A)R5#e&ffAr14qXsZ`zS(C3VV9VvsAZZGO~?CdOIo`6cNhLC
z^HL01JyGkJo(L<8kRy(}KjmXZ1hrH$FLp|yN64y&ru2Ua0k-$ne`I8p$sD`r+SX7?
zL4;CIn7H+ur4nZ|VI2l(KiXXSYx(}&8`H3`OBT=T?i}<IFIZ<zw)B<1zy+z|FRfH*
zZzgy-eRt;<V2}2K!>mdg)X<5<FSjt_2u>cC*u6>!T+h{1Ft_oNX#U4mF2+ssIoOJ|
z4o69HP<I^1V7Ql!w@`|5??%t2<%OREw)F^p^!>WIWx+J#iM6pJChQHKWER9?jiXk1
zxf|93&$Jy2TiFjflFywDFF7Og?Y0{At^Q?_(qG&@t}P{31@i8~-ni$#26jqJng)0)
z3y;utetfL`B;8qoQ0$+Eg@+t+L`O_H1|aC64LxteLsu7IVO|v?IBX2zbbbq`JMJ!_
zFSGB*=XG#7U^;!SyZ7yIu<EjbRW%|lr!_`<*!oiA5HS!T8+AA&&t5mL!+OV0zD&^7
z9g1UivXN<<z^D0$zir`Q`>~Dhs%M_PP0H0^UUB>pQ}$+oiIhw>BEU24aNtAD*!CO1
z=eHZmBKl?i_$VADF3_?H4Cv*R$^!!f+87(N4fk(sVSd|3sb8K|oQ2(1K3U^V701Mc
z*65mQkJjhh0ycpF!RxZ`fDf8i5tHKS5`09_bm*LIj<r`Om==r4z-q7jHgBY5u5M-j
z!{m*ylTFUhh$8`fp)xBPCKoN0Z31oXzW}?`Z!b5}ls^|1nvc~m->UTNLnxXGbm<Sq
zEpHWW3)t_rfDN$r<**_<-lRH-c$)yZ_QcSPCfhxC6KG|84}6%tao{a(;_ST4y>iv)
z+vB87U>bLsxe4S%z23s+_TN%ZUoOchYkX;}CDzLhlcn{99fqwPv;u(Y(jVrI_zl)o
zK2&J$IlI4@Rc-=U>5}&Up1$3}<TlLE5nl17H(@9>UU@L!&EeQI4fqSNE%coch?j?L
ZKxu`3#5Am#xN8$w@M--&rgS!6{V&j>XNdp+

literal 0
HcmV?d00001

diff --git a/raspimouse_gazebo/models/course_curve_50x50cm/meshes/course_curve_50x50cm.dae b/raspimouse_gazebo/models/course_curve_50x50cm/meshes/course_curve_50x50cm.dae
new file mode 100644
index 0000000..2390079
--- /dev/null
+++ b/raspimouse_gazebo/models/course_curve_50x50cm/meshes/course_curve_50x50cm.dae
@@ -0,0 +1,115 @@
+<?xml version="1.0" encoding="utf-8"?>
+<COLLADA xmlns="http://www.collada.org/2005/11/COLLADASchema" version="1.4.1" xmlns:xsi="http://www.w3.org/2001/XMLSchema-instance">
+  <asset>
+    <contributor>
+      <author>YusukeKato</author>
+      <authoring_tool>Blender 4.0.0 commit date:2023-11-13, commit time:17:26, hash:878f71061b8e</authoring_tool>
+    </contributor>
+    <created>2023-11-16T14:58:23</created>
+    <modified>2023-11-16T14:58:23</modified>
+    <unit name="meter" meter="1"/>
+    <up_axis>Z_UP</up_axis>
+  </asset>
+  <library_effects>
+    <effect id="Material_001-effect">
+      <profile_COMMON>
+        <newparam sid="course_curve_jpg-surface">
+          <surface type="2D">
+            <init_from>course_curve_jpg</init_from>
+          </surface>
+        </newparam>
+        <newparam sid="course_curve_jpg-sampler">
+          <sampler2D>
+            <source>course_curve_jpg-surface</source>
+          </sampler2D>
+        </newparam>
+        <technique sid="common">
+          <lambert>
+            <emission>
+              <color sid="emission">0 0 0 1</color>
+            </emission>
+            <diffuse>
+              <texture texture="course_curve_jpg-sampler" texcoord="Plane-mesh-map-0"/>
+            </diffuse>
+            <index_of_refraction>
+              <float sid="ior">1.45</float>
+            </index_of_refraction>
+          </lambert>
+        </technique>
+      </profile_COMMON>
+    </effect>
+  </library_effects>
+  <library_images>
+    <image id="course_curve_jpg" name="course_curve_jpg">
+      <init_from>course_curve.jpg</init_from>
+    </image>
+  </library_images>
+  <library_materials>
+    <material id="Material_001-material" name="Material.001">
+      <instance_effect url="#Material_001-effect"/>
+    </material>
+  </library_materials>
+  <library_geometries>
+    <geometry id="Plane-mesh" name="Plane">
+      <mesh>
+        <source id="Plane-mesh-positions">
+          <float_array id="Plane-mesh-positions-array" count="12">-0.5 -0.5 0 0.5 -0.5 0 -0.5 0.5 0 0.5 0.5 0</float_array>
+          <technique_common>
+            <accessor source="#Plane-mesh-positions-array" count="4" stride="3">
+              <param name="X" type="float"/>
+              <param name="Y" type="float"/>
+              <param name="Z" type="float"/>
+            </accessor>
+          </technique_common>
+        </source>
+        <source id="Plane-mesh-normals">
+          <float_array id="Plane-mesh-normals-array" count="3">0 0 1</float_array>
+          <technique_common>
+            <accessor source="#Plane-mesh-normals-array" count="1" stride="3">
+              <param name="X" type="float"/>
+              <param name="Y" type="float"/>
+              <param name="Z" type="float"/>
+            </accessor>
+          </technique_common>
+        </source>
+        <source id="Plane-mesh-map-0">
+          <float_array id="Plane-mesh-map-0-array" count="12">1.00069e-4 0.9999001 0.9998998 9.998e-5 0.9998999 0.9998998 1.00069e-4 0.9999001 9.998e-5 1.00131e-4 0.9998998 9.998e-5</float_array>
+          <technique_common>
+            <accessor source="#Plane-mesh-map-0-array" count="6" stride="2">
+              <param name="S" type="float"/>
+              <param name="T" type="float"/>
+            </accessor>
+          </technique_common>
+        </source>
+        <vertices id="Plane-mesh-vertices">
+          <input semantic="POSITION" source="#Plane-mesh-positions"/>
+        </vertices>
+        <triangles material="Material_001-material" count="2">
+          <input semantic="VERTEX" source="#Plane-mesh-vertices" offset="0"/>
+          <input semantic="NORMAL" source="#Plane-mesh-normals" offset="1"/>
+          <input semantic="TEXCOORD" source="#Plane-mesh-map-0" offset="2" set="0"/>
+          <p>1 0 0 2 0 1 0 0 2 1 0 3 3 0 4 2 0 5</p>
+        </triangles>
+      </mesh>
+    </geometry>
+  </library_geometries>
+  <library_visual_scenes>
+    <visual_scene id="Scene" name="Scene">
+      <node id="Plane" name="Plane" type="NODE">
+        <matrix sid="transform">0.5 0 0 0 0 0.5 0 0 0 0 0.5 0 0 0 0 1</matrix>
+        <instance_geometry url="#Plane-mesh" name="Plane">
+          <bind_material>
+            <technique_common>
+              <instance_material symbol="Material_001-material" target="#Material_001-material">
+                <bind_vertex_input semantic="Plane-mesh-map-0" input_semantic="TEXCOORD" input_set="0"/>
+              </instance_material>
+            </technique_common>
+          </bind_material>
+        </instance_geometry>
+      </node>
+    </visual_scene>
+  </library_visual_scenes>
+  <scene>
+    <instance_visual_scene url="#Scene"/>
+  </scene>
+</COLLADA>
diff --git a/raspimouse_gazebo/models/course_curve_50x50cm/model.config b/raspimouse_gazebo/models/course_curve_50x50cm/model.config
new file mode 100644
index 0000000..58e33ed
--- /dev/null
+++ b/raspimouse_gazebo/models/course_curve_50x50cm/model.config
@@ -0,0 +1,16 @@
+<?xml version="1.0"?>
+
+<model>
+  <name>course_curve_50x50cm</name>
+  <version>1.0</version>
+  <sdf version="1.5">model.sdf</sdf>
+
+  <author>
+    <name>YusukeKato</name>
+    <email>yusuke.kato@rt-net.jp</email>
+  </author>
+
+  <description>
+    line follower course
+  </description>
+</model>
diff --git a/raspimouse_gazebo/models/course_curve_50x50cm/model.sdf b/raspimouse_gazebo/models/course_curve_50x50cm/model.sdf
new file mode 100644
index 0000000..84ba3e6
--- /dev/null
+++ b/raspimouse_gazebo/models/course_curve_50x50cm/model.sdf
@@ -0,0 +1,34 @@
+<?xml version="1.0" ?>
+<sdf version="1.5">
+  <model name="course_curve_50x50cm">
+    <static>true</static>
+    <link name="link">
+      <collision name="collision">
+        <pose>0 0 0 0 0 0</pose>
+        <geometry>
+          <mesh>
+            <uri>model://course_curve_50x50cm/meshes/course_curve_50x50cm.dae</uri>
+            <scale>1 1 1</scale>
+          </mesh>
+        </geometry>
+        <surface>
+          <friction>
+            <ode>
+              <mu>0.9</mu>
+              <mu2>0.9</mu2>
+            </ode>
+          </friction>
+        </surface>
+      </collision>
+      <visual name="visual">
+        <pose>0 0 0 0 0 0</pose>
+        <geometry>
+          <mesh>
+            <uri>model://course_curve_50x50cm/meshes/course_curve_50x50cm.dae</uri>
+            <scale>1 1 1</scale>
+          </mesh>
+        </geometry>
+      </visual>
+    </link>
+  </model>
+</sdf>
diff --git a/raspimouse_gazebo/models/course_straight_50x50cm/meshes/course_straight.jpg b/raspimouse_gazebo/models/course_straight_50x50cm/meshes/course_straight.jpg
new file mode 100644
index 0000000000000000000000000000000000000000..4bc01c5229cabeef9aea2e3b32778a43ffc64a76
GIT binary patch
literal 5959
zcmex=<NpH&0WUXCHwH#V1_nkTWcYuZ!I^=X2?RhSGZ3(_v48*v8yhPdCkGc7CkH1d
z7Y{!V7dIa_Cnv8UFCV{vfS>>ukC3pCfH06P@c#e<HwW_z<`;~Nf(-wUFo*%o2bzrx
zI5~jgasog*nb?uVC0W@y!ZM~VyYl4!Ed~ydE_;Sm3CJo&*`pya8UmvsFd71*Auyan
zfHU0kR_wETOvPJvpWVaqJhOau1?Ra-@6A34&s};i_kp^#_nzAa{K}?RZf}_LR_}8@
z<EZk{kQqXWz-z;B&b^fQjqN`}t55Lr*P*+vRH<ks&9{$Qdu{PW#bA-2zpmzOmFwi1
zvHbkC)uk)Gc!V6atJ@mA)_sxFGR@ClSKZCB6%sY{pT9Qjb>NE$E4ym`W^Iq^cNsNo
pG|Wbm#%Ok;ZK<(Ufs!(BRPSgAjE2By2#kinXb23Y5a9oR69D2_Fy#OM

literal 0
HcmV?d00001

diff --git a/raspimouse_gazebo/models/course_straight_50x50cm/meshes/course_straight_50x50cm.dae b/raspimouse_gazebo/models/course_straight_50x50cm/meshes/course_straight_50x50cm.dae
new file mode 100644
index 0000000..a5c1745
--- /dev/null
+++ b/raspimouse_gazebo/models/course_straight_50x50cm/meshes/course_straight_50x50cm.dae
@@ -0,0 +1,115 @@
+<?xml version="1.0" encoding="utf-8"?>
+<COLLADA xmlns="http://www.collada.org/2005/11/COLLADASchema" version="1.4.1" xmlns:xsi="http://www.w3.org/2001/XMLSchema-instance">
+  <asset>
+    <contributor>
+      <author>YusukeKato</author>
+      <authoring_tool>Blender 4.0.0 commit date:2023-11-13, commit time:17:26, hash:878f71061b8e</authoring_tool>
+    </contributor>
+    <created>2023-11-16T14:55:03</created>
+    <modified>2023-11-16T14:55:03</modified>
+    <unit name="meter" meter="1"/>
+    <up_axis>Z_UP</up_axis>
+  </asset>
+  <library_effects>
+    <effect id="Material_001-effect">
+      <profile_COMMON>
+        <newparam sid="course_straight_jpg-surface">
+          <surface type="2D">
+            <init_from>course_straight_jpg</init_from>
+          </surface>
+        </newparam>
+        <newparam sid="course_straight_jpg-sampler">
+          <sampler2D>
+            <source>course_straight_jpg-surface</source>
+          </sampler2D>
+        </newparam>
+        <technique sid="common">
+          <lambert>
+            <emission>
+              <color sid="emission">0 0 0 1</color>
+            </emission>
+            <diffuse>
+              <texture texture="course_straight_jpg-sampler" texcoord="Plane-mesh-map-0"/>
+            </diffuse>
+            <index_of_refraction>
+              <float sid="ior">1.45</float>
+            </index_of_refraction>
+          </lambert>
+        </technique>
+      </profile_COMMON>
+    </effect>
+  </library_effects>
+  <library_images>
+    <image id="course_straight_jpg" name="course_straight_jpg">
+      <init_from>course_straight.jpg</init_from>
+    </image>
+  </library_images>
+  <library_materials>
+    <material id="Material_001-material" name="Material.001">
+      <instance_effect url="#Material_001-effect"/>
+    </material>
+  </library_materials>
+  <library_geometries>
+    <geometry id="Plane-mesh" name="Plane">
+      <mesh>
+        <source id="Plane-mesh-positions">
+          <float_array id="Plane-mesh-positions-array" count="12">-0.5 -0.5 0 0.5 -0.5 0 -0.5 0.5 0 0.5 0.5 0</float_array>
+          <technique_common>
+            <accessor source="#Plane-mesh-positions-array" count="4" stride="3">
+              <param name="X" type="float"/>
+              <param name="Y" type="float"/>
+              <param name="Z" type="float"/>
+            </accessor>
+          </technique_common>
+        </source>
+        <source id="Plane-mesh-normals">
+          <float_array id="Plane-mesh-normals-array" count="3">0 0 1</float_array>
+          <technique_common>
+            <accessor source="#Plane-mesh-normals-array" count="1" stride="3">
+              <param name="X" type="float"/>
+              <param name="Y" type="float"/>
+              <param name="Z" type="float"/>
+            </accessor>
+          </technique_common>
+        </source>
+        <source id="Plane-mesh-map-0">
+          <float_array id="Plane-mesh-map-0-array" count="12">1.00069e-4 0.9999001 0.9998998 9.998e-5 0.9998999 0.9998998 1.00069e-4 0.9999001 9.998e-5 1.00131e-4 0.9998998 9.998e-5</float_array>
+          <technique_common>
+            <accessor source="#Plane-mesh-map-0-array" count="6" stride="2">
+              <param name="S" type="float"/>
+              <param name="T" type="float"/>
+            </accessor>
+          </technique_common>
+        </source>
+        <vertices id="Plane-mesh-vertices">
+          <input semantic="POSITION" source="#Plane-mesh-positions"/>
+        </vertices>
+        <triangles material="Material_001-material" count="2">
+          <input semantic="VERTEX" source="#Plane-mesh-vertices" offset="0"/>
+          <input semantic="NORMAL" source="#Plane-mesh-normals" offset="1"/>
+          <input semantic="TEXCOORD" source="#Plane-mesh-map-0" offset="2" set="0"/>
+          <p>1 0 0 2 0 1 0 0 2 1 0 3 3 0 4 2 0 5</p>
+        </triangles>
+      </mesh>
+    </geometry>
+  </library_geometries>
+  <library_visual_scenes>
+    <visual_scene id="Scene" name="Scene">
+      <node id="Plane" name="Plane" type="NODE">
+        <matrix sid="transform">0.5 0 0 0 0 0.5 0 0 0 0 0.5 0 0 0 0 1</matrix>
+        <instance_geometry url="#Plane-mesh" name="Plane">
+          <bind_material>
+            <technique_common>
+              <instance_material symbol="Material_001-material" target="#Material_001-material">
+                <bind_vertex_input semantic="Plane-mesh-map-0" input_semantic="TEXCOORD" input_set="0"/>
+              </instance_material>
+            </technique_common>
+          </bind_material>
+        </instance_geometry>
+      </node>
+    </visual_scene>
+  </library_visual_scenes>
+  <scene>
+    <instance_visual_scene url="#Scene"/>
+  </scene>
+</COLLADA>
diff --git a/raspimouse_gazebo/models/course_straight_50x50cm/model.config b/raspimouse_gazebo/models/course_straight_50x50cm/model.config
new file mode 100644
index 0000000..6c7928f
--- /dev/null
+++ b/raspimouse_gazebo/models/course_straight_50x50cm/model.config
@@ -0,0 +1,16 @@
+<?xml version="1.0"?>
+
+<model>
+  <name>course_straight_50x50cm</name>
+  <version>1.0</version>
+  <sdf version="1.5">model.sdf</sdf>
+
+  <author>
+    <name>YusukeKato</name>
+    <email>yusuke.kato@rt-net.jp</email>
+  </author>
+
+  <description>
+    line follower course
+  </description>
+</model>
diff --git a/raspimouse_gazebo/models/course_straight_50x50cm/model.sdf b/raspimouse_gazebo/models/course_straight_50x50cm/model.sdf
new file mode 100644
index 0000000..17e9f0d
--- /dev/null
+++ b/raspimouse_gazebo/models/course_straight_50x50cm/model.sdf
@@ -0,0 +1,34 @@
+<?xml version="1.0" ?>
+<sdf version="1.5">
+  <model name="course_straight_50x50cm">
+    <static>true</static>
+    <link name="link">
+      <collision name="collision">
+        <pose>0 0 0 0 0 0</pose>
+        <geometry>
+          <mesh>
+            <uri>model://course_straight_50x50cm/meshes/course_straight_50x50cm.dae</uri>
+            <scale>1 1 1</scale>
+          </mesh>
+        </geometry>
+        <surface>
+          <friction>
+            <ode>
+              <mu>0.9</mu>
+              <mu2>0.9</mu2>
+            </ode>
+          </friction>
+        </surface>
+      </collision>
+      <visual name="visual">
+        <pose>0 0 0 0 0 0</pose>
+        <geometry>
+          <mesh>
+            <uri>model://course_straight_50x50cm/meshes/course_straight_50x50cm.dae</uri>
+            <scale>1 1 1</scale>
+          </mesh>
+        </geometry>
+      </visual>
+    </link>
+  </model>
+</sdf>
diff --git a/raspimouse_gazebo/worlds/line_follower_field1.sdf b/raspimouse_gazebo/worlds/line_follower_field1.sdf
new file mode 100644
index 0000000..275ef4f
--- /dev/null
+++ b/raspimouse_gazebo/worlds/line_follower_field1.sdf
@@ -0,0 +1,76 @@
+<?xml version="1.0" ?>
+<sdf version="1.6">
+  <world name="default">
+    <physics name="10ms" type="ignored">
+      <max_step_size>0.010</max_step_size>
+      <real_time_factor>1.0</real_time_factor>
+    </physics>
+    <plugin
+      filename="ignition-gazebo-physics-system"
+      name="ignition::gazebo::systems::Physics">
+    </plugin>
+    <plugin
+      filename="ignition-gazebo-user-commands-system"
+      name="ignition::gazebo::systems::UserCommands">
+    </plugin>
+    <plugin
+      filename="ignition-gazebo-scene-broadcaster-system"
+      name="ignition::gazebo::systems::SceneBroadcaster">
+    </plugin>
+
+    <include>
+      <uri>
+        https://fuel.gazebosim.org/1.0/OpenRobotics/models/Sun
+      </uri>
+    </include>
+
+    <include>
+      <uri>
+        https://fuel.gazebosim.org/1.0/OpenRobotics/models/Ground%20Plane
+      </uri>
+    </include>
+
+    <model name="straight_1">
+      <include>
+        <uri>model://course_straight_50x50cm</uri>
+      </include>
+      <pose>0 0 0.01 0 0 0</pose>
+    </model>
+
+    <model name="curve_1">
+      <include>
+        <uri>model://course_curve_50x50cm</uri>
+      </include>
+      <pose>0.5 0 0.01 0 0 0</pose>
+    </model>
+
+    <model name="curve_2">
+      <include>
+        <uri>model://course_curve_50x50cm</uri>
+      </include>
+      <pose>0.5 0.5 0.01 0 0 1.57</pose>
+    </model>
+
+    <model name="straight_2">
+      <include>
+        <uri>model://course_straight_50x50cm</uri>
+      </include>
+      <pose>0 0.5 0.01 0 0 0</pose>
+    </model>
+
+    <model name="curve_3">
+      <include>
+        <uri>model://course_curve_50x50cm</uri>
+      </include>
+      <pose>-0.5 0 0.01 0 0 -1.57</pose>
+    </model>
+
+    <model name="curve_4">
+      <include>
+        <uri>model://course_curve_50x50cm</uri>
+      </include>
+      <pose>-0.5 0.5 0.01 0 0 3.14</pose>
+    </model>
+
+  </world>
+</sdf>