Joint trajectory controller in ROS with Python and RRRbot