CS 6613 Robot Path Planning

CS 6613 all 2024 Project 1: Robot Path Planning

1. K. WongTotal # points = 100.

Project Description: Implement the A* search algorithm with graph search (no repeated states)for the robot path planning problem as described below. The inputs to your program are the startand goal positions of a point robot, and a 2D integer array that represents the robot workspace. Therobot can move from cell to cell in any of the eight directions as shown in Figure 2. The goal is tofind the lowest-cost path between the start position and the goal position, and avoiding obstaclesalong the path. The workspace is represented as an occupancy grid as shown in Figure 1, where theblack cells represent obstacles. The red line in the figure depicts a pathfrom the start position tothe goal position. (Note: the path in the figure is not the lowest-cost path as required in our project.)Formulation: The problem can be formulated in the following way. Each cell in the workspace isa state. The white cells are legal states and the black cells are illegal states. The actions are theeight moves as defined in Figure 2. The step cost for the actions is the sum of the angle cost andthe distance cost; i.e.,𝑐𝑐(𝑠𝑠, 𝑎𝑎, 𝑠𝑠′ ) = 𝑐𝑐𝑎𝑎(𝑠𝑠, 𝑎𝑎, 𝑠𝑠′ ) + 𝑐𝑐𝑑𝑑(𝑠𝑠, 𝑎𝑎, 𝑠𝑠′ )where𝑐𝑐𝑎𝑎(𝑠𝑠, 𝑎𝑎, 𝑠𝑠′ ) = 𝑘𝑘 ∗ 180 ∆𝜃𝜃 ; let 𝑐𝑐𝑎𝑎(𝑠𝑠, 𝑎𝑎, 𝑠𝑠′ ) = 0 if s is the initial state (start position)∆𝜃𝜃 = |(𝜃𝜃(𝑠𝑠′ ) − 𝜃𝜃(𝑠𝑠)|; if ∆𝜃𝜃 > 180, let ∆𝜃𝜃 equals 360 − ∆𝜃𝜃𝑐𝑐𝑑𝑑(𝑠𝑠, 𝑎𝑎, 𝑠𝑠′ ) = 1 for horizontal and vertical moves 0, 2, 4, 6 and √2 for diagonal moves 1,3, 5, 7.In the above, s is the current state, a is the action and s’ is the next state. The angle cost is to penalizeany change in the direction of the robot between two consecutive moves. k is a constant that wecan set to control the amount of penalty we want to impose for angle change. For the initial state(start position), we let the angle cost between the initial state s andnextstate s’ equals to 0. Thedistance cost is for the distance travelled in an action. Let ℎ(𝑛𝑛) be the Euclidian distance betweenthe current position and the goal position. ℎ(𝑛𝑛) thus defined is admissible in this problem. Duringthe search, only legal states (cells without obstacles) will be added to the tree.Input and output formats: The workspace in the test input files is of size 30 × 50 (rows xcolumns.) We will use the coordinate system as shown in Figure 3 below. The coordinates of thelower-left corner cell are (𝑖𝑖,𝑗𝑗) = (0,0). The input file contains 31 lines of integers as shown inFigure 4 below. Line 1 contains the (𝑖𝑖,𝑗𝑗) coordinates of the start and goal positions of the pointrobot. Lines 2 to 31 contain the cell values of the robot workspace, with 0’s representing whitecells, 1’s representing black cells, 2 representing the start position and 5representing the goalposition. Line 2 contains values for (𝑖𝑖,𝑗𝑗) = (𝑖𝑖, 29), with 𝑖𝑖 = 0 to 49. Line 31 contains values for𝑖𝑖,𝑗𝑗) = (𝑖𝑖, 0), with 𝑖𝑖 = 0 to 49, etc. The integers in each line are separated by blank spaces.Your program will produce an output text file that contains 34 lines of text as shown in Figure 5below. Line 1 contains the depth level d of the goal node as found by the A*algorithm (assumethat the root node is at level 0.) Line 2 contains the total number of nodes N generated in your tree(including the root node.) Line 3 contains the solution (a sequence ofmoves from the root node tothe goal node) represented by a’s. The a’s are separated by blanks. Each a is a move from the set{0,1,2,3,4,5,6,7}. Line 4 contains the f(n) values of the nodes (separatedby blanks,) from the rootnode to the goal node, along the solution path. There should be d numberof a values in line 3 and CS 6613 Fall 2024

Project 1: Robot Path Planning

1. K. Wongd+1 number of f values in line 4. Lines 5 to 34 contain values for the robot workspace, with 0’srepresenting white cells, 1’s representing black cells, 2 representing the start position, 5representing the goal position, and 4’s representing cells along the solution path (excluding the startposition and the goal position.)Figure 3. Coordinate system of the work space. CS 6613Fall 2024 Project 1: Robot Path Planning

1. K. WongTesting your program: Three input test files代写CS 6613 Robot Path Planning  will be provided on Brightspace for you to test yourprogram. For each input file, try two different runs: one with k = 2 and one with k =4. You can letk be an interactive input parameter in your program.

Recommended languages: Python, C++/C or Java. If you would like to use a different language,send me an email first.

Teammate: You can work on the project by yourself or form a team of two to work on the project.You can discuss with your classmates how to do the project, but every team is expected to writetheir own code and submit their own project.Submit on Brightspace:Your source code file. Put comments in your source code to make it easier for someoneelse to read your program. Points will be taken off if you do not have comments in yoursource code.

• The output files generated by your program for the three input test files.
• A PDF report that contains instructions on how to run your program. If your programrequires compilation, instructions on how to compile your program should also beprovided. Also, copy and paste your output files and your source code onto the PDF file.This is in addition to the source code file and output files that you have to hand inseparately, as described in items (1) and (2) above.

• If you work in a team of two, only one partner needs to submit the project on Brightspacebut put down both partners’ names on the source code and the PDF report.m m m m m m ….m 5. Output file format (34 lines.) d, N, a’s, and

m’s are integers. f’s are floating point numbers. Thea’s, f’s and m’s are separated by blanks.n n n nm m m m m m ….mm m m m m m ….m…

m m m m m m ….mFigure 4. Input file format (31 lines.) n’sand m’s are integers separated by blanks.