ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange |
1 | initial version |
From the video it looks to me like you are updating the orientation and position in x and y, but you are not increasing the z height. Without doing that it's going to form circles not a spiral.
Also, you will need to compute the orientation of each point as a combination of the rotation and the incline.