[jsk_robot_startup/smach_to_mail] Use yaml file to set address

jsk_robot_common/jsk_robot_startup/scripts/smach_to_mail.py

@@ -3,9 +3,11 @@
 import base64
 import cv2
 import datetime
+import os
 import pickle
 import rospy
 import sys
+import yaml
 
 from cv_bridge import CvBridge
 from jsk_robot_startup.msg import Email
@@ -28,16 +30,27 @@ def __init__(self):
         self.bridge = CvBridge()
         self.smach_state_list = {}  # for status list
         self.smach_state_subject = {}  # for status subject
-        if rospy.has_param("~sender_address"):
-            self.sender_address = rospy.get_param("~sender_address")
+        yaml_path = rospy.get_param(
+            '~email_info', "/var/lib/robot/email_info.yaml")
+        if os.path.exists(yaml_path):
+            with open(yaml_path) as yaml_f:
+                self.email_info = yaml.load(yaml_f)
+            rospy.loginfo(
+                "{} is loaded as email config file.".format(yaml_path))
+            rospy.loginfo(self.email_info)
+            self.sender_address = self.email_info['sender_address']
+            self.receiver_address = self.email_info['receiver_address']
         else:
-            rospy.logerr("Please set rosparam {}/sender_address".format(
-                rospy.get_name()))
-        if rospy.has_param("~receiver_address"):
-            self.receiver_address = rospy.get_param("~receiver_address")
-        else:
-            rospy.logerr("Please set rosparam {}/receiver_address".format(
+            if rospy.has_param("~sender_address"):
+                self.sender_address = rospy.get_param("~sender_address")
+            else:
+                rospy.logerr("Please set rosparam {}/sender_address".format(
                     rospy.get_name()))
+            if rospy.has_param("~receiver_address"):
+                self.receiver_address = rospy.get_param("~receiver_address")
+            else:
+                rospy.logerr("Please set rosparam {}/receiver_address".format(
+                        rospy.get_name()))
 
 
     def _status_cb(self, msg):