Test Script

RRT_Test_Script added for testing smoothing