drone: Add service availability check to led module

This commit is contained in:
Arthur Golubtsov
2020-06-20 04:02:06 +03:00
parent 7a2fef888f
commit eab82d2e4a

View File

@@ -1,4 +1,13 @@
import rospy
import logging
from clover.srv import SetLEDEffect
set_effect = rospy.ServiceProxy('led/set_effect', SetLEDEffect)
logger = logging.getLogger(__name__)
set_effect_service = rospy.ServiceProxy('led/set_effect', SetLEDEffect)
def set_effect(*args, **kwargs):
try:
set_effect_service(*args, **kwargs)
except rospy.ServiceException:
logger.error("Can't set led effect: service /led/set_effect is unavailable!")