This repo is my answer to the 2023 DSO Challege 3 - Robotic Autonomy.
A robot has to move from an initial position of [0,0] to a goal at [90, 50]. The map contains obstacles and terrain. The objective is to reach the goal with as little energy expended as possible.
- The robot takes the lowest cost action at each step without backtracking.
- The cost is a weighted sum of the control action and the distance to goal.
- The lowest recorded cost is 203.5685 [4dp] where the gains used are 4.5 and 1.0 for the distance to goal cost and control action cost respectively.
- An improvement that can be made is to allow the search to backtrack to the previous taken step when no optimal solution is found.
- from current position, search adjacent boxes and assign costs.
- Arrange all possibilities in a search list by ascending cost.
- Iterate, if the possible position is not in path history, select the possible position as current position.
- If current position == goal, break