From 479d7aa8de9fb1daa07f790e532efee3697fb8c6 Mon Sep 17 00:00:00 2001
From: ferran <ferranmafe@github.com>
Date: Thu, 7 Sep 2017 13:24:23 +0200
Subject: [PATCH] QR_detector changed current camera frame_id

---
 .../msg/humanoid_follow_targetAction.msg        |   5 +++++
 .../humanoid_follow_targetActionFeedback.msg    |   5 +++++
 .../msg/humanoid_follow_targetActionGoal.msg    |   5 +++++
 .../msg/humanoid_follow_targetActionResult.msg  |   5 +++++
 .../msg/humanoid_follow_targetFeedback.msg      |   6 ++++++
 .../msg/humanoid_follow_targetGoal.msg          |   6 ++++++
 .../msg/humanoid_follow_targetResult.msg        |   3 +++
 .../msg/humanoid_gripperAction.msg              |   5 +++++
 .../msg/humanoid_gripperActionFeedback.msg      |   5 +++++
 .../msg/humanoid_gripperActionGoal.msg          |   5 +++++
 .../msg/humanoid_gripperActionResult.msg        |   5 +++++
 .../msg/humanoid_gripperFeedback.msg            |   5 +++++
 .../msg/humanoid_gripperGoal.msg                |   3 +++
 .../msg/humanoid_gripperResult.msg              |   3 +++
 .../msg/humanoid_motionAction.msg               |   5 +++++
 .../msg/humanoid_motionActionFeedback.msg       |   5 +++++
 .../msg/humanoid_motionActionGoal.msg           |   5 +++++
 .../msg/humanoid_motionActionResult.msg         |   5 +++++
 .../msg/humanoid_motionFeedback.msg             |   5 +++++
 .../msg/humanoid_motionGoal.msg                 |   3 +++
 .../msg/humanoid_motionResult.msg               |   3 +++
 .../msg/humanoid_stairsAction.msg               |   5 +++++
 .../msg/humanoid_stairsActionFeedback.msg       |   5 +++++
 .../msg/humanoid_stairsActionGoal.msg           |   5 +++++
 .../msg/humanoid_stairsActionResult.msg         |   5 +++++
 .../msg/humanoid_stairsFeedback.msg             |   4 ++++
 .../msg/humanoid_stairsGoal.msg                 |   3 +++
 .../msg/humanoid_stairsResult.msg               |   3 +++
 qr_detector/include/.qr_detector_driver.h.swp   | Bin 0 -> 16384 bytes
 qr_detector/src/qr_detector_driver_node.cpp     |   6 +++---
 30 files changed, 130 insertions(+), 3 deletions(-)
 create mode 100644 humanoid_common_msgs/msg/humanoid_follow_targetAction.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_follow_targetActionFeedback.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_follow_targetActionGoal.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_follow_targetActionResult.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_follow_targetFeedback.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_follow_targetGoal.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_follow_targetResult.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_gripperAction.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_gripperActionFeedback.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_gripperActionGoal.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_gripperActionResult.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_gripperFeedback.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_gripperGoal.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_gripperResult.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_motionAction.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_motionActionFeedback.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_motionActionGoal.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_motionActionResult.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_motionFeedback.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_motionGoal.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_motionResult.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_stairsAction.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_stairsActionFeedback.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_stairsActionGoal.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_stairsActionResult.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_stairsFeedback.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_stairsGoal.msg
 create mode 100644 humanoid_common_msgs/msg/humanoid_stairsResult.msg
 create mode 100644 qr_detector/include/.qr_detector_driver.h.swp

diff --git a/humanoid_common_msgs/msg/humanoid_follow_targetAction.msg b/humanoid_common_msgs/msg/humanoid_follow_targetAction.msg
new file mode 100644
index 0000000..414a053
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_follow_targetAction.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+humanoid_follow_targetActionGoal action_goal
+humanoid_follow_targetActionResult action_result
+humanoid_follow_targetActionFeedback action_feedback
diff --git a/humanoid_common_msgs/msg/humanoid_follow_targetActionFeedback.msg b/humanoid_common_msgs/msg/humanoid_follow_targetActionFeedback.msg
new file mode 100644
index 0000000..1fd67e2
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_follow_targetActionFeedback.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+Header header
+actionlib_msgs/GoalStatus status
+humanoid_follow_targetFeedback feedback
diff --git a/humanoid_common_msgs/msg/humanoid_follow_targetActionGoal.msg b/humanoid_common_msgs/msg/humanoid_follow_targetActionGoal.msg
new file mode 100644
index 0000000..c4fe78c
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_follow_targetActionGoal.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+Header header
+actionlib_msgs/GoalID goal_id
+humanoid_follow_targetGoal goal
diff --git a/humanoid_common_msgs/msg/humanoid_follow_targetActionResult.msg b/humanoid_common_msgs/msg/humanoid_follow_targetActionResult.msg
new file mode 100644
index 0000000..5ae6aee
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_follow_targetActionResult.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+Header header
+actionlib_msgs/GoalStatus status
+humanoid_follow_targetResult result
diff --git a/humanoid_common_msgs/msg/humanoid_follow_targetFeedback.msg b/humanoid_common_msgs/msg/humanoid_follow_targetFeedback.msg
new file mode 100644
index 0000000..ffc82fb
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_follow_targetFeedback.msg
@@ -0,0 +1,6 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+#feedback
+float32 current_pan
+float32 current_tilt
+
+
diff --git a/humanoid_common_msgs/msg/humanoid_follow_targetGoal.msg b/humanoid_common_msgs/msg/humanoid_follow_targetGoal.msg
new file mode 100644
index 0000000..9159452
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_follow_targetGoal.msg
@@ -0,0 +1,6 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+#goal definition
+float32 target_pan
+float32 target_tilt
+float32[] pan_range
+float32[] tilt_range
diff --git a/humanoid_common_msgs/msg/humanoid_follow_targetResult.msg b/humanoid_common_msgs/msg/humanoid_follow_targetResult.msg
new file mode 100644
index 0000000..979b112
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_follow_targetResult.msg
@@ -0,0 +1,3 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+#result definition
+bool    successful
diff --git a/humanoid_common_msgs/msg/humanoid_gripperAction.msg b/humanoid_common_msgs/msg/humanoid_gripperAction.msg
new file mode 100644
index 0000000..227fc76
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_gripperAction.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+humanoid_gripperActionGoal action_goal
+humanoid_gripperActionResult action_result
+humanoid_gripperActionFeedback action_feedback
diff --git a/humanoid_common_msgs/msg/humanoid_gripperActionFeedback.msg b/humanoid_common_msgs/msg/humanoid_gripperActionFeedback.msg
new file mode 100644
index 0000000..7d85806
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_gripperActionFeedback.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+Header header
+actionlib_msgs/GoalStatus status
+humanoid_gripperFeedback feedback
diff --git a/humanoid_common_msgs/msg/humanoid_gripperActionGoal.msg b/humanoid_common_msgs/msg/humanoid_gripperActionGoal.msg
new file mode 100644
index 0000000..d80f3b0
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_gripperActionGoal.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+Header header
+actionlib_msgs/GoalID goal_id
+humanoid_gripperGoal goal
diff --git a/humanoid_common_msgs/msg/humanoid_gripperActionResult.msg b/humanoid_common_msgs/msg/humanoid_gripperActionResult.msg
new file mode 100644
index 0000000..5f78645
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_gripperActionResult.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+Header header
+actionlib_msgs/GoalStatus status
+humanoid_gripperResult result
diff --git a/humanoid_common_msgs/msg/humanoid_gripperFeedback.msg b/humanoid_common_msgs/msg/humanoid_gripperFeedback.msg
new file mode 100644
index 0000000..adfab76
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_gripperFeedback.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+#feedback
+float32 current_angle_top
+float32 current_angle_bot
+
diff --git a/humanoid_common_msgs/msg/humanoid_gripperGoal.msg b/humanoid_common_msgs/msg/humanoid_gripperGoal.msg
new file mode 100644
index 0000000..5959135
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_gripperGoal.msg
@@ -0,0 +1,3 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+#goal definition
+bool    open
diff --git a/humanoid_common_msgs/msg/humanoid_gripperResult.msg b/humanoid_common_msgs/msg/humanoid_gripperResult.msg
new file mode 100644
index 0000000..979b112
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_gripperResult.msg
@@ -0,0 +1,3 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+#result definition
+bool    successful
diff --git a/humanoid_common_msgs/msg/humanoid_motionAction.msg b/humanoid_common_msgs/msg/humanoid_motionAction.msg
new file mode 100644
index 0000000..dc70ec5
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_motionAction.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+humanoid_motionActionGoal action_goal
+humanoid_motionActionResult action_result
+humanoid_motionActionFeedback action_feedback
diff --git a/humanoid_common_msgs/msg/humanoid_motionActionFeedback.msg b/humanoid_common_msgs/msg/humanoid_motionActionFeedback.msg
new file mode 100644
index 0000000..ff4d786
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_motionActionFeedback.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+Header header
+actionlib_msgs/GoalStatus status
+humanoid_motionFeedback feedback
diff --git a/humanoid_common_msgs/msg/humanoid_motionActionGoal.msg b/humanoid_common_msgs/msg/humanoid_motionActionGoal.msg
new file mode 100644
index 0000000..d0e38d3
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_motionActionGoal.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+Header header
+actionlib_msgs/GoalID goal_id
+humanoid_motionGoal goal
diff --git a/humanoid_common_msgs/msg/humanoid_motionActionResult.msg b/humanoid_common_msgs/msg/humanoid_motionActionResult.msg
new file mode 100644
index 0000000..58b2f12
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_motionActionResult.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+Header header
+actionlib_msgs/GoalStatus status
+humanoid_motionResult result
diff --git a/humanoid_common_msgs/msg/humanoid_motionFeedback.msg b/humanoid_common_msgs/msg/humanoid_motionFeedback.msg
new file mode 100644
index 0000000..a729a54
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_motionFeedback.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+#feedback
+int32   current_page
+int32   current_step
+
diff --git a/humanoid_common_msgs/msg/humanoid_motionGoal.msg b/humanoid_common_msgs/msg/humanoid_motionGoal.msg
new file mode 100644
index 0000000..a9d8514
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_motionGoal.msg
@@ -0,0 +1,3 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+#goal definition
+int32   motion_id
diff --git a/humanoid_common_msgs/msg/humanoid_motionResult.msg b/humanoid_common_msgs/msg/humanoid_motionResult.msg
new file mode 100644
index 0000000..979b112
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_motionResult.msg
@@ -0,0 +1,3 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+#result definition
+bool    successful
diff --git a/humanoid_common_msgs/msg/humanoid_stairsAction.msg b/humanoid_common_msgs/msg/humanoid_stairsAction.msg
new file mode 100644
index 0000000..e73bdd4
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_stairsAction.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+humanoid_stairsActionGoal action_goal
+humanoid_stairsActionResult action_result
+humanoid_stairsActionFeedback action_feedback
diff --git a/humanoid_common_msgs/msg/humanoid_stairsActionFeedback.msg b/humanoid_common_msgs/msg/humanoid_stairsActionFeedback.msg
new file mode 100644
index 0000000..e2b6428
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_stairsActionFeedback.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+Header header
+actionlib_msgs/GoalStatus status
+humanoid_stairsFeedback feedback
diff --git a/humanoid_common_msgs/msg/humanoid_stairsActionGoal.msg b/humanoid_common_msgs/msg/humanoid_stairsActionGoal.msg
new file mode 100644
index 0000000..4870591
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_stairsActionGoal.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+Header header
+actionlib_msgs/GoalID goal_id
+humanoid_stairsGoal goal
diff --git a/humanoid_common_msgs/msg/humanoid_stairsActionResult.msg b/humanoid_common_msgs/msg/humanoid_stairsActionResult.msg
new file mode 100644
index 0000000..046a7d3
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_stairsActionResult.msg
@@ -0,0 +1,5 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+
+Header header
+actionlib_msgs/GoalStatus status
+humanoid_stairsResult result
diff --git a/humanoid_common_msgs/msg/humanoid_stairsFeedback.msg b/humanoid_common_msgs/msg/humanoid_stairsFeedback.msg
new file mode 100644
index 0000000..86ec233
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_stairsFeedback.msg
@@ -0,0 +1,4 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+#feedback
+int32   current_phase
+
diff --git a/humanoid_common_msgs/msg/humanoid_stairsGoal.msg b/humanoid_common_msgs/msg/humanoid_stairsGoal.msg
new file mode 100644
index 0000000..9d2eb25
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_stairsGoal.msg
@@ -0,0 +1,3 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+#goal definition
+bool    up
diff --git a/humanoid_common_msgs/msg/humanoid_stairsResult.msg b/humanoid_common_msgs/msg/humanoid_stairsResult.msg
new file mode 100644
index 0000000..979b112
--- /dev/null
+++ b/humanoid_common_msgs/msg/humanoid_stairsResult.msg
@@ -0,0 +1,3 @@
+# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
+#result definition
+bool    successful
diff --git a/qr_detector/include/.qr_detector_driver.h.swp b/qr_detector/include/.qr_detector_driver.h.swp
new file mode 100644
index 0000000000000000000000000000000000000000..b1aa67cdfa285d2450455b304169e07f8a6958a1
GIT binary patch
literal 16384
zcmeHOTc{*Q8E&IVj7dz0282MU?3%rt%+Bm?)W~Fa;be9<JFvUwWX{=*3n61ocg=LU
zJzbsZ>T`AyT@@u7l84|W1cDFI_z(~xk_+A*1VscPf*6bhq98t~_@aXN5d8kC>Y1K7
zdlHN<LHe-Y%sJiFfBp6Sm#X@^cCi0!_Y}LM`H=uW*9XCC{coH*8eSj#Di4C8(3+=o
z<IR6uyM3p4c$ZS=SGC%v`9;^TCAHj_@Bw}IH}h7m!&Y33d8%a857l_A($)jI9|<Eu
zqjXEAVNyh*daWO6xgm5j-lnJea?L=^z*YvX4Q@YpU_V{ox#Jf0fg8?jZBk#U8K@bk
z8K@bk8K@bk8K@bk8K@cfzh%H=mj$22=q~dk<o^3z3*Ybdf1mK*gN6J4&-$xopk|<E
zpk|<Epk|<Epk|<Epk|<Epk|<Epl0A5$N-Pr-v67l;m7;`a{vFG>w@5E;1S?qU;x|%
z{PO)l@Fjo)_X9TpuU;DjPXZjcAGiVd#Wg|jGvGmBH}LA!LGW#011NyAz#YKHfUAJl
z-xmZg0gnR@0VALX+ym?et^uwFt^{7c3g;AnM}dz6e|~QeJOw-qd;vHJ{OQUdcm{YH
zSOqQvUbrF%HUR@<zyY8Id>DA+@*wyF@O$7D;AP-B;91}kz^%Z|z+c}J1b+ek2>cxQ
z37~-ez+T`+;Df-mz&}tl`5W*pphpE1;B^#Qehd5v_#yB-@D%WMpbK0MyZ~ERdsu&A
z_*r7&fr2MFGrADXz+LKUc^A*cQF|1k-Hy~sCel578;qwcH{1xc=4mdCR4J1=%Y+^(
zJr)s@L#Bl(bjmh(QV1{4@bdx<Q==FULsg`v$<|{$I4shz6v7Lm#@xt|C&`4-C*%z#
ztkfxGrus+&e+uSKYp`*V8#WM3LC;h~O-2f*G957-G*LP)8#q~B;(Y@x#n3+E<<O1R
z(o$d>+@p{Bb0Ut1JsUVhviDB+aLawMF`rPsAW$)db0dl35sQVMQn_r5mV?3w3|6bL
zReH>2%2E|g)ejS%=WLF3mKR~nc+L`~vc3lA4d10qrQwNukcPP)t6Z>*Yd(gq7-t9z
zmHOnufOFd;@#06ZcS`!y+Md}^r8&HSPR3M4YLTG#h{1Toc%F$+4rN$U?|O8)c?~_W
z6?t@HN^D1^Lpfr&jj#R!q1~JnS!6pD;B#W+SWGo8pK&er>?PlGj#7@rdesKkk`EHW
zV(<q)s(MO=t4ItboTcO_9F{t<p-f5xZW$7(UUo1yEHlXjM6${Oqjr1dM1IunYhlov
z(kYp;0_L<V!=Te{7>Q=?$#S4at@4cf%dW|$G_iervD+qFMh`w%<Ty*jSfmJK#Bc6K
zI6qEDji=knE{DokRtypuwq1~PT#P)RLvrV(@?@18U#rD3q!7v%d=>^gjTpQ&RuOgW
z8?=Lm0v81{)t$q#w(pVAp{@bal0Tx=ZqEfwz?Kk{OZZnxXNf$I;83|a4do~!oWLP6
zcnxWwh4a5c3%cv>fZQcEPY+W=%V-CkQA6gmv=+m`GCm@EEd-&7wJJt22}95z9K)EW
zBY0XgN%`0(IAk_5bZ=!1mwAfIRh<~mGO%ndL}4zF2AAyjj34h1<hQ915mLDA49-iL
zv&fithXw8O0{H{c0f8iQR3Lk#M!-fXWoMD+l41wh8d;r(h(6>4iX!JeyOHjv`Nk5K
z^C6NCayDg|1_(lj4W<i-1JSurnH{P3K5lRsV@F&!Sr>m$>a_WL>j=FEILd9Csd21E
zi@8W+E|c2&HnHJH2&U&e#VT!ixAPk`q@)K&XgX`ytJc%DOm;{onzFqXJenZ+ll>#o
zTkw2>1dpiQRQfzwg7_Oz-kxSJUQ(FPe9Wbv&TY4q#v-%8CNdHUl9RP*Wy~OMVa(1s
z=Emn;R1I+`5(=l@btqTbc}Av~prolxNZnqS(S+|C%t>po%~)b8%Cy>mR?sLeUB~Bn
zdYb55D`y68whr|c*tEYBbl9VoY==t`E@3p|9YL!+g;`CUKE%N=Ca^>fG}jZHEGvZ^
z%1tCLgd#IXDi<kB%5<oz*IX;4x#~so({STpE0&`eRF~h)ILj{8OpZqweAx2ewi&DR
zTS@q>EzucQCCd2>W{;^>GFlUjgPlJ2_A6pN9sRhEZigw&GTYn+oh&vcYqwgP@;v%$
z7FpO7IY<U$%`DDZJvC5RW##>od_c{$fS-`ZQaU1A(u0U`WHyTYv4Y1Ft(q2RDs9s<
zJ}Ks*mYK<2+#t>&wOoN9AdnGwWS4M7PD?SDC#TP>CTJr_8quOv-e0)IBE?RxtTTiH
z@{7$HbcPobmko<q;v&UErIFGNLIy6^V%<}#E4}sQ)9WPRSlg{O?HomGf`PztbR<$i
z@rjj<%h#Apod&a&8i^wCL}36vpCXXp4~Xq?ld<j)D>>6(ITGlhlKIWe<|r+iN{?Dd
z;v&sqfFn&3bWRm4k5!RimB=>)rF?<&#u54sRfZJmW}CZDpJ6946d2}it7gJh?X=5I
zI(d*q;@+~|%!G(LE|c79aq3vFa{}Zn-_<?YT|dWQ=HuP<)5q4<*zuJfTV|`vz4dPA
z%*o{*TRqcTU0FMZp{`+w6#VEH3tDz>cm2f5nRT{&`W(A=xz~fdb9Y*f6z*d2=9Zq6
zy(9*>$?3?qp&^n4yHN8q(lRcRNW*raJYA5*h*NZk2}2sl#SDb06bqzbku?1Hac`mu
zjhTmBlV<h_qt&WrSUcvpWQR-saa=?DH8nKQ1Ak!;f<-18G?>7mY4!lSy|jU6x&d}b
zVd#KoC{iE|J&g0R;aeL4E@xLwc?=>36DtlU)#3B|vhyPv{*ctmy?SjLlno>;X1tIF
zm{40bCL=ktV%#nY%T>D#<Jyo?h^JDv=ZRK-8rcq!qXoPQ9%q?ZE)bO3x_AffXPdA+
zoxSYf{sa5>;o|`7VpAXuEQ+;{PaT{|T=p3u<oG?p{tIjFq`^9C-Oj!<tDR;*`~PFu
z|9&3(W7_|puzSuR_&4_YuK~XSegJ$Q_#W^i@D<=V@OSL}p8>uITm(J|oC6L6hk%a)
zR3Eqz_$g`vp9XFN-atLzU%>BxUjr`zF9Od2PXLbthk<{hE<iPd3xEdJfm6Ui-~g}$
zTnAA7;K!&7q`+BV75ETv1Mmv!11|$#1HKA$fL*|?z|FuFKmfdmn!$I0XMx9nM}bw~
z7T|es^BC|5@MVCw`W#UI)C|-N)C|-N)C|0B26l=R%Y-2KjH||A&(v<yG>w()NSJ<z
z&8p^oyJ@Y~HmS^s3RoK5)7uknwA-h+*~La$Ot8o$5gYdZ&e0aE6nBK}GJMpRQQoMw
zm}?#>tY5_uc4QY-WJK-@skSo|Drq~Dqo%pXwWGb@g~sgnNwql@K+AT+3k_@&NHiNl
zLH}zwyBgA?wzze1wl{Md)aszAc7z{PMCjA4PO;f7%b~P)MhS$Lv9Vv*s==o~1TDMx
zfEK*2_+p<?6IxzbN$!*Ro$}GCM7lmLh+=g~i%MT0nN?Tp!?;QHWGug^T4~E3TX%+)
zYK<?gkv^!zqr#0{hONU0<9M)?yW&^h7gAj%X&1^!n|+j%8mvI|;`W1m!xB869NxcJ
z_P)<5>F)YZY}8$$fQI7a5;?B)pCu?HIWF8M^AdcIcKrCg<e;q0*(JKG!puGG6rNQT
zJ=<l$vaHYA;)vUZknl@Lo$f18rov(yJX%$}l3iaJpT4HJq?yW>3)8~&v<xfLtT1zm
z&r0J|M|Lz(gQ+hJlu9sQm2K~%>^}dB#kDPL%?_KQxsJAdC3C6wJ=?u{=`OwpT7zP5
z@*W74Cj2Z}e=A=bl(xvreJ?g~*!Mv{)CUmxMMhSlEl}lMke9POq^+E(-mSj&K`9bj
zca-9s6>X)F>RRH02n*WWx#F0MD<{$m_GYk8%x*6l0o$o}s1=~uJI4&x+{Am;7_c(l
z6l#=L-r5MXZQafawwnAuTA}(z@>1?Ud)K(d;X72!eiN$a!pu9D8;Z+XE;ra3HyHWv
s--CLQi;1Wj1=I9nsRG?+{p&B<>nE<jWs7^4iU9k}w&YWx^lfwhALmLVX#fBK

literal 0
HcmV?d00001

diff --git a/qr_detector/src/qr_detector_driver_node.cpp b/qr_detector/src/qr_detector_driver_node.cpp
index 235e4e5..abfcb7f 100644
--- a/qr_detector/src/qr_detector_driver_node.cpp
+++ b/qr_detector/src/qr_detector_driver_node.cpp
@@ -71,13 +71,13 @@ void QrDetectorDriverNode::image_callback(const sensor_msgs::Image::ConstPtr& ms
   
     this->driver_.findQR(this->gray,tag_ids,poses);
     this->camera_pose_tag_pose_array_msg_.header.stamp       = ros::Time::now();
-    this->camera_pose_tag_pose_array_msg_.header.frame_id    = msg->header.frame_id;
+    this->camera_pose_tag_pose_array_msg_.header.frame_id    = this->driver_.get_camera_frame();
     this->camera_pose_tag_pose_array_msg_.tags.resize(tag_ids.size());
     for(unsigned int i=0;i<tag_ids.size();i++)
     {
       this->camera_pose_tag_pose_array_msg_.tags[i].tag_id          = tag_ids[i];
       this->camera_pose_tag_pose_array_msg_.tags[i].header.stamp    = ros::Time::now();
-      this->camera_pose_tag_pose_array_msg_.tags[i].header.frame_id = msg->header.frame_id;
+      this->camera_pose_tag_pose_array_msg_.tags[i].header.frame_id = this->driver_.get_camera_frame();
       this->camera_pose_tag_pose_array_msg_.tags[i].position.x      = poses[i][0];
       this->camera_pose_tag_pose_array_msg_.tags[i].position.y      = poses[i][1];
       this->camera_pose_tag_pose_array_msg_.tags[i].position.z      = poses[i][2];
@@ -87,7 +87,7 @@ void QrDetectorDriverNode::image_callback(const sensor_msgs::Image::ConstPtr& ms
       this->camera_pose_tag_pose_array_msg_.tags[i].orientation.z   = poses[i][6];      
       transform.setOrigin(tf::Vector3(poses[i][0],poses[i][1],poses[i][2]));
       transform.setRotation(tf::Quaternion(poses[i][4],poses[i][5],poses[i][6],poses[i][3]));
-      this->tag_pose_br.sendTransform(tf::StampedTransform(transform,ros::Time::now(),msg->header.frame_id,tag_ids[i]+"_det"));
+      this->tag_pose_br.sendTransform(tf::StampedTransform(transform,ros::Time::now(),this->driver_.get_camera_frame(),tag_ids[i]+"_det"));
     }
     this->camera_pose_publisher_.publish(this->camera_pose_tag_pose_array_msg_);
   }
-- 
GitLab