Merge branch 'master' into develop/pr2

jsk_naoqi_robot/README.md

@@ -57,6 +57,8 @@ If this happens, please connect Pepper to network with DHCP and exit Setting.
 For ros kinetic, please refer to install guide like [here](http://wiki.ros.org/kinetic/Installation).
 For ros melodic, please refer to install guide like [here](http://wiki.ros.org/melodic/Installation).
 
+% As mentioned in https://github.com/ros-naoqi/naoqi_driver#launch, naoqi_driver for ROS melodic and greater have to be used for robots running NAOqi 2.9 and greater. Using ROS melodic on Pepper running NAOqi OS 2.5 has some known issue like this: https://github.com/ros-naoqi/naoqi_driver/issues/96
+
 1. Install ``Python NAOqi SDK``
 You can download it (version = 2.5.5) from [here](https://drive.google.com/file/d/1xHuYREDa78xGiikEpsjxfZQ7Gfvo1E9D/view?usp=sharing).  
 Please unzip the downloaded file.  
@@ -124,6 +126,8 @@ source devel/setup.bash
 
 Confirm that you get the following output when you type `wstool info`
 
+% UID of jsk_robot may change from below, but there is no problem. That is because this package is in active developpment.
+
 ```
 $ cd ~/catkin_ws/src
 $ wstool info
@@ -132,13 +136,13 @@ workspace: /home/leus/catkin_ws/src
  Localname         S SCM Version (Spec)    UID  (Spec)  URI  (Spec) [http(s)://...]
  ---------         - --- --------------    -----------  ---------------------------
  pepper_robot        git master  (-)       efad3979b374 github.com/ros-naoqi/pepper_robot
- naoqi_driver      M git kochigami-develop 98c0b678286a github.com/kochigami/naoqi_driver
- naoqi_dashboard     git kochigami-develop 33962f146c77 github.com/kochigami/naoqi_dashboard
+ naoqi_driver        git kochigami-develop 98c0b678286a github.com/kochigami/naoqi_driver
+ naoqi_dashboard     git kochigami-develop 7f32005e08e0 github.com/kochigami/naoqi_dashboard
  naoqi_bridge_msgs   git kochigami-develop d7417613690e github.com/kochigami/naoqi_bridge_msgs
  naoqi_bridge        git kochigami-develop c28b727e1e9b github.com/kochigami/naoqi_bridge
  nao_robot           git master  (-)       67476469a137 github.com/ros-naoqi/nao_robot
  nao_interaction     git master  (-)       f97ad12f3896 github.com/ros-naoqi/nao_interaction
- jsk_robot           git master            1f44c97c7855 github.com/jsk-ros-pkg/jsk_robot.git
+ jsk_robot           git master            d551865511c3 github.com/jsk-ros-pkg/jsk_robot.git
 ```
 
 ## Interface when controlling NAO and Pepper via roseus

jsk_naoqi_robot/cross/build_user.sh

@@ -88,6 +88,7 @@ docker run -it --rm \
 cp -a ${PWD}/startup_scripts/user_setup.bash ${SOURCE_ROOT}/
 cp -a ${PWD}/startup_scripts/start.sh ${SOURCE_ROOT}/
 cp -a ${PWD}/startup_scripts/screenrc ${SOURCE_ROOT}/
+cp -a ${PWD}/startup_scripts/attach.sh ${SOURCE_ROOT}/
 
 echo "
 

jsk_naoqi_robot/cross/startup_scripts/attach.sh

@@ -0,0 +1,2 @@
+source User/user_setup.bash
+screen -c User/screenrc -r

jsk_naoqi_robot/jsk_pepper_startup/apps/meeting/meeting.app

@@ -2,4 +2,4 @@ display: Meeting
 platform: pepper
 launch: jsk_pepper_startup/meeting.xml
 interface: jsk_pepper_startup/meeting.interface
-icon: jsk_pepper_startup/meeting.png
+icon: jsk_pepper_startup/meeting.jpg

jsk_naoqi_robot/jsk_pepper_startup/apps/meeting/meeting.xml

@@ -1,7 +1,4 @@
 <launch>
-  <include file="$(find naoqi_apps)/launch/tablet.launch" />
-  <include file="$(find naoqi_apps)/launch/basic_awareness.launch" />
-  <include file="$(find naoqi_apps)/launch/background_movement.launch" />
   <node pkg="jsk_pepper_startup" name="meeting"
         type="meeting.l" args="'(main)'" />
 </launch>

jsk_naoqi_robot/jsk_pepper_startup/apps/meeting/scripts/meeting.l

@@ -53,11 +53,10 @@
 (defvar *pose6* (list #f(2.0 -2.0 -5.0 110.0 35.0 -40.0 -60.0 -40.0 110.0 -35.0 40.0 60.0 40.0 0.0 15.0) #f(2.0 -2.0 -5.0 110.0 35.0 -40.0 -60.0 -40.0 110.0 -35.0 40.0 60.0 40.0 0.0 15.0) #f(2.0 -2.0 -5.0 85.0 10.0 -70.0 -20.0 -40.0 85.0 -10.0 70.0 20.0 40.0 0.0 0.0)))
 (defvar *time6* (list 2000 3000 1000))
 
-;;
+;; poses for byebye
 (defvar *reset* #f(2.0 -2.0 -5.0 85.0 10.0 -70.0 -20.0 -40.0 85.0 -10.0 70.0 20.0 40.0 0.0 0.0))
-(defvar *a* #f(2.0 -2.0 -5.0 0.0 10.0 -100.0 -70.0 60.0 0.0 -10.0 100.0 70.0 -60.0 0.0 0.0))
-(defvar *d* #f(2.0 -2.0 -5.0 0.0 10.0 -110.0 -70.0 60.0 0.0 -10.0 110.0 70.0 -60.0 0.0 -10.0))
-(defvar *e* #f(2.0 -2.0 -5.0 0.0 10.0 -110.0 -70.0 60.0 0.0 -10.0 110.0 70.0 -60.0 0.0 -10.0))
+(defvar *byebye-close* #f(2.0 -2.0 -5.0 0.0 10.0 -100.0 -70.0 60.0 0.0 -10.0 100.0 70.0 -60.0 0.0 0.0))
+(defvar *byebye-open* #f(2.0 -2.0 -5.0 0.0 10.0 -110.0 -70.0 60.0 0.0 -10.0 110.0 70.0 -60.0 0.0 -10.0))
 
 (defvar *img-list*
   (list
@@ -86,15 +85,7 @@
 
 (ros::roseus "online-meeting-enhancement-main")
 
-(ros::subscribe "joy" sensor_msgs::Joy
-                #'(lambda (msg)
-                    (let ((button (send msg :buttons)))
-                      (ros::ros-info "received joy button ~A" button)
-                      (when (eq (elt button 3) 1)
-                        (send *ri* :speak "はい")
-                        (setq *continue* nil)))))
-
-(defun start-func (args)
+(defun start-func (&rest args)
   (let ()
     (setq *last-tm* (ros::time-now))
     ;;
@@ -114,14 +105,16 @@
     (set-alist 'description "" args)
     :started))
 
-(defun end-func (args)
+(defun end-func (&rest args)
   (let ()
     (send *ri* :show-image "golden-saying-by-pepper-7.png")
+    (send *ri* :set-basic-awareness-enabled nil)
+    (send *ri* :set-background-movement-enabled nil)
     (send *ri* :angle-vector-sequence (list #f(2.0 -2.0 -5.0 85.0 20.0 -70.0 -20.0 -40.0 85.0 -20.0 70.0 20.0 40.0 30.0 -10.0) #f(2.0 -2.0 -5.0 85.0 10.0 -70.0 -20.0 -40.0 85.0 -10.0 70.0 20.0 40.0 0.0 0.0) #f(2.0 -2.0 -5.0 85.0 20.0 -70.0 -20.0 -40.0 85.0 -20.0 70.0 20.0 40.0 -30.0 -10.0) #f(2.0 -2.0 -5.0 85.0 10.0 -70.0 -20.0 -40.0 85.0 -10.0 70.0 20.0 40.0 0.0 0.0)) (list 1000 1000 1000 1000))
     (send *ri* :speak "\\vct=120\\\\rspd=80\\みなさん")
     (send *ri* :wait-interpolation)
 
-    (send *ri* :angle-vector-sequence (list *a* *d* *a* *d* *a* *d* *a* *d* *a* *e* *reset*) (list 1000 1000 1000 1000 1000 1000 1000 1000 1000 1000 3000))
+    (send *ri* :angle-vector-sequence (list *byebye-close* *byebye-open* *byebye-close* *byebye-open* *byebye-close* *byebye-open* *byebye-close* *byebye-open* *byebye-close* *byebye-open* *reset*) (list 1000 1000 1000 1000 1000 1000 1000 1000 1000 1000 3000))
     (send *ri* :speak "\\vct=120\\\\rspd=80\\おつかれさまでしたッ！\\rspd=100\\")
     (send *ri* :wait-interpolation)
     (send *ri* :hide-image)
@@ -130,7 +123,7 @@
     (set-alist 'description "End Meeting" args)
     :finished))
 
-(defun comment-func (args)
+(defun comment-func (&rest args)
   (let (count str (wait 600) tm)
     ;; cleanup description/image
     (set-alist 'description "" args)

jsk_naoqi_robot/jsk_pepper_startup/launch/jsk_pepper_startup.launch

@@ -15,6 +15,11 @@
     <arg name="network_interface" value="$(arg network_interface)"/>
   </include>
 
+  <!-- Please clone https://github.com/kochigami/naoqi_bridge/tree/kochigami-develop -->
+  <include file="$(find naoqi_apps)/launch/tablet.launch" />
+  <include file="$(find naoqi_apps)/launch/basic_awareness.launch" />
+  <include file="$(find naoqi_apps)/launch/background_movement.launch" />
+
   <node pkg="jsk_pepper_startup" name="take_wakeup_pose" type="take_wakeup_pose.py" if="$(arg autonomous_wakeup)" />
 
   <!-- node to publish compressed image -->

jsk_panda_robot/jsk_panda_teleop/package.xml

@@ -1,4 +1,5 @@
-<package>
+<?xml version="1.0"?>
+<package format="3">
   <name>jsk_panda_teleop</name>
   <version>1.1.0</version>
   <description>Teleopration of dual-franka using TouchUSB</description>
@@ -11,29 +12,31 @@
   <buildtool_depend>catkin</buildtool_depend>
   <build_depend>message_generation</build_depend>
 
-  <run_depend>message_runtime</run_depend>
-  <run_depend>rospy</run_depend>
+  <exec_depend>message_runtime</exec_depend>
+  <exec_depend>rospy</exec_depend>
 
-  <run_depend>franka_description</run_depend>
-  <run_depend>franka_msgs</run_depend>
-  <run_depend>franka_gripper</run_depend>
-  <run_depend>franka_control</run_depend>
-  <run_depend>franka_example_controllers</run_depend>
-  <run_depend>franka_visualization</run_depend>
+  <exec_depend>franka_description</exec_depend>
+  <exec_depend>franka_msgs</exec_depend>
+  <exec_depend>franka_gripper</exec_depend>
+  <exec_depend>franka_control</exec_depend>
+  <exec_depend>franka_example_controllers</exec_depend>
+  <exec_depend>franka_visualization</exec_depend>
 
-  <run_depend>omni_common</run_depend>
-  <run_depend>omni_msgs</run_depend>
+  <exec_depend>omni_common</exec_depend>
+  <exec_depend>omni_msgs</exec_depend>
 
-  <run_depend>python-scipy</run_depend>
-  <run_depend>python-numpy</run_depend>
-  <run_depend>python-absl-py-pip</run_depend>
+  <exec_depend condition="$ROS_PYTHON_VERSION == 2">python-scipy</exec_depend>
+  <exec_depend condition="$ROS_PYTHON_VERSION == 3">python3-scipy</exec_depend>
+  <exec_depend condition="$ROS_PYTHON_VERSION == 2">python-numpy</exec_depend>
+  <exec_depend condition="$ROS_PYTHON_VERSION == 3">python3-numpy</exec_depend>
+  <exec_depend>python-absl-py-pip</exec_depend>
 
-  <run_depend>jsk_panda_startup</run_depend>
-  <run_depend>jsk_teleop_joy</run_depend>
+  <exec_depend>jsk_panda_startup</exec_depend>
+  <exec_depend>jsk_teleop_joy</exec_depend>
 
-  <run_depend>audio_capture</run_depend>
-  <run_depend>audio_play</run_depend>
-  <run_depend>audio_common_msgs</run_depend>
-  <run_depend>sound_classification</run_depend>
+  <exec_depend>audio_capture</exec_depend>
+  <exec_depend>audio_play</exec_depend>
+  <exec_depend>audio_common_msgs</exec_depend>
+  <exec_depend>sound_classification</exec_depend>
 
 </package>

jsk_pr2_robot/jsk_pr2_startup/jsk_pr2_sensors/manager.launch.xml

@@ -1,3 +1,7 @@
+<!-- this file is copied and modified from $(find rgbd_launch)/launch/includes/manager.launch.xml -->
+<!-- this file is modified from original to add respawn arguments -->
+<!-- see https://github.com/ros-drivers/rgbd_launch/pull/40 -->
+
 <!-- Start nodelet manager -->
 <launch>
 

jsk_pr2_robot/jsk_pr2_startup/jsk_pr2_sensors/openni.launch

@@ -1,3 +1,7 @@
+<!-- this file is copied and modified from $(find openni_launch)/launch/openni.launch -->
+<!-- this launch is modified from original to add manager_respawn arguments -->
+<!-- see https://github.com/ros-drivers/openni_camera/pull/78 -->
+
 <!-- Entry point for using OpenNI devices -->
 <launch>
 

jsk_robot_common/jsk_robot_startup/lifelog/common_logger.launch

@@ -5,6 +5,9 @@
   <arg name="save_tf" default="true" />
   <arg name="save_joint_states" default="true" />
   <arg name="save_speech" default="true" />
+  <arg name="save_faces" default="true" />
+  <arg name="save_dialogflow" default="true" />
+  <arg name="save_google_chat" default="true" />
   <arg name="save_smach" default="true" />
   <arg name="save_base_trajectory" default="false" />
   <arg name="save_object_detection" default="false" />
@@ -236,6 +239,48 @@
       </rosparam>
     </node>
 
+    <!-- face save aws face data -->
+    <node if="$(arg save_faces)"
+          name="face_logger"
+          pkg="jsk_robot_startup" type="mongo_record.py"
+          machine="$(arg machine)"
+          respawn="$(arg respawn)">
+      <rosparam subst_value="true">
+        topics:
+        - /aws_auto_checkin_app/class
+        - /aws_detect_faces/attributes
+      </rosparam>
+    </node>
+
+    <!-- face dialogflow I/O -->
+    <node if="$(arg save_dialogflow)"
+          name="dialogflow_logger"
+          pkg="jsk_robot_startup" type="mongo_record.py"
+          machine="$(arg machine)"
+          respawn="$(arg respawn)">
+      <rosparam subst_value="true">
+        topics:
+        - /dialogflow_client/text_action/goal
+        - /dialogflow_client/text_action/result
+      </rosparam>
+    </node>
+
+    <!-- google chat -->
+    <node if="$(arg save_google_chat)"
+          name="google_chat_logger"
+          pkg="jsk_robot_startup" type="mongo_record.py"
+          machine="$(arg machine)"
+          respawn="$(arg respawn)">
+      <rosparam subst_value="true">
+        topics:
+        - /google_chat_ros/send/goal
+        - /google_chat_ros/send/result
+        - /google_chat_ros/message_activity
+        - /google_chat_ros
+        - /google_chat_ros/card_activity
+      </rosparam>
+    </node>
+
     <!-- base trajecotry logger -->
     <node if="$(arg save_base_trajectory)"
           name="base_trajectory_logger"