# -*- coding: utf-8 -*- # # Software License Agreement (BSD License) # # Copyright (c) 2019-2022, Martin Günther (DFKI GmbH) and others # Copyright (c) 2013-2016, Brandon Alexander # # All rights reserved. # # Redistribution and use in source and binary forms, with or without # modification, are permitted provided that the following conditions # are met: # # * Redistributions of source code must retain the above copyright # notice, this list of conditions and the following disclaimer. # * Redistributions in binary form must reproduce the above # copyright notice, this list of conditions and the following # disclaimer in the documentation and/or other materials provided # with the distribution. # * Neither the name of this project nor the names of its # contributors may be used to endorse or promote products derived # from this software without specific prior written permission. # # THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS # "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT # LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS # FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE # COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, # INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, # BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; # LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER # CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT # LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN # ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE # POSSIBILITY OF SUCH DAMAGE. import numpy as np import struct import sys import unittest import rospy from rospy.exceptions import ROSInitException from rospy_message_converter import message_converter python3 = sys.hexversion > 0x03000000 class TestMessageConverter(unittest.TestCase): def test_ros_message_with_array(self): from rospy_message_converter.msg import TestArray expected_dictionary = {'data': [1.1, 2.2, 3.3]} message = TestArray(data=expected_dictionary['data']) message = serialize_deserialize(message) dictionary = message_converter.convert_ros_message_to_dictionary(message) self.assertEqual(dictionary, expected_dictionary) def test_ros_message_with_bool(self): from std_msgs.msg import Bool expected_dictionary = {'data': True} message = Bool(data=expected_dictionary['data']) message = serialize_deserialize(message) dictionary = message_converter.convert_ros_message_to_dictionary(message) self.assertEqual(dictionary, expected_dictionary) def test_ros_message_with_byte(self): from std_msgs.msg import Byte expected_dictionary = {'data': 5} message = Byte(data=expected_dictionary['data']) message = serialize_deserialize(message) dictionary = message_converter.convert_ros_message_to_dictionary(message) self.assertEqual(dictionary, expected_dictionary) def test_ros_message_with_char(self): from std_msgs.msg import Char expected_dictionary = {'data': 99} message = Char(data=expected_dictionary['data']) message = serialize_deserialize(message) dictionary = message_converter.convert_ros_message_to_dictionary(message) self.assertEqual(dictionary, expected_dictionary) def test_ros_message_with_duration(self): from std_msgs.msg import Duration duration = rospy.rostime.Duration(33, 25) expected_dictionary = {'data': {'secs': duration.secs, 'nsecs': duration.nsecs}} message = Duration(data=duration) message = serialize_deserialize(message) dictionary = message_converter.convert_ros_message_to_dictionary(message) self.assertEqual(dictionary, expected_dictionary) def test_ros_message_with_empty(self): from std_msgs.msg import Empty expected_dictionary = {} message = Empty() message = serialize_deserialize(message) dictionary = message_converter.convert_ros_message_to_dictionary(message) self.assertEqual(dictionary, expected_dictionary) def test_ros_message_with_float32(self): from std_msgs.msg import Float32 expected_dictionary = {'data': struct.unpack('