Robot system based on ROS/OROCOS solving Rubik's cube