fixed bugs in python and with ROS