#Robotics Club - MoPAT
#Motion Planning Algorithm implementations

#Import required libraries
import numpy as np

#Create initial map
def init_map(x_seg, y_seg, robot_pos, dest_pos, obs_pos):
    map = np.zeros((np.shape(y_seg)[0]-2,np.shape(x_seg)[0]))
    robot_x = 
    return map, start_coor, dest_coor

#Djakstra's algorithm for static environment
def djakstras(init_map, star_coor, dest_coor):
    #Set start coor

    #Set end coor

    #Initializer distance array
    dist_from_start = np.full(init_map.shape, np.inf)

#A* algorithm for static environment

d1e6bfca717ce8c86825536e3b9d84b0e5c28fb4
#Robotics Club - MoPAT
#Motion Planning Algorithm implementations

#Import required libraries
import numpy as np

#Create initial map
def init_map(x_seg, y_seg, robot_pos, dest_pos, obs_pos):
    map = np.zeros((np.shape(y_seg)[0]-2,np.shape(x_seg)[0]))
    robot_x = 
    return map, start_coor, dest_coor

#Djakstra's algorithm for static environment
def djakstras(init_map, star_coor, dest_coor):
    #Set start coor

    #Set end coor

    #Initializer distance array
    dist_from_start = np.full(init_map.shape, np.inf)

#A* algorithm for static environment
