p_obstacles done

FinalProject/Check_Point_5/check_point5.py

 import vrep
 import time
 import numpy as np
-import math
-from numpy.linalg import multi_dot, norm, inv
-from scipy.linalg import expm, logm
-from usefulFunctions import *
-import transforms3d
-
-'''
-https://matthew-brett.github.io/transforms3d/reference/transforms3d.euler.html#transforms3d.euler.euler2mat
-pip install transforms3d
-'''
 
 # Close all open connections (just in case)
 vrep.simxFinish(-1)