Merge pull request AtsushiSakai#92 from jwdinius/conda_env

AtsushiSakai · web-flow · commit e21eb3215be3 · 2018-07-30T20:44:59.000+09:00
add environment.yml to setup conda environment
diff --git a/PathPlanning/Eta3SplinePath/eta3_spline_path.py b/PathPlanning/Eta3SplinePath/eta3_spline_path.py
@@ -13,6 +13,7 @@
 
 import numpy as np
 import matplotlib.pyplot as plt
+from scipy.integrate import quad
 
 # NOTE: *_pose is a 3-array: 0 - x coord, 1 - y coord, 2 - orientation angle \theta
 
@@ -151,6 +152,10 @@ def __init__(self, start_pose, end_pose, eta=None, kappa=None):
             + (10. * eta[1] - 2. * eta[3] + 1. / 6 * eta[5]) * sb \
             - (2. * eta[1]**2 * kappa[2] - 1. / 6 * eta[1]**3 *
                kappa[3] - 1. / 2 * eta[1] * eta[3] * kappa[2]) * cb
+        
+        s_dot = lambda u : np.linalg.norm(self.coeffs[:, 1:].dot(np.array([1, 2.*u, 3.*u**2, 4.*u**3, 5.*u**4, 6.*u**5, 7.*u**6])))
+        self.segment_length = quad(lambda u: s_dot(u), 0, 1)[0]
+
     """
     eta3_path_segment::calc_point
 
@@ -159,7 +164,6 @@ def __init__(self, start_pose, end_pose, eta=None, kappa=None):
     returns
         (x,y) of point along the segment
     """
-
     def calc_point(self, u):
         assert(u >= 0 and u <= 1)
         return self.coeffs.dot(np.array([1, u, u**2, u**3, u**4, u**5, u**6, u**7]))
diff --git a/environment.yml b/environment.yml
@@ -0,0 +1,9 @@
+name: python_robotics
+dependencies:
+- python==3.6
+- matplotlib
+- scipy
+- numpy
+- pandas
+- pip:
+    - cvxpy
