Fix missing joint_position_action in path (#371)

* Fix missing joint_position_action in path

* Fix test

Author: eugeneteoh

.github/workflows/build.yml

@@ -32,7 +32,7 @@ jobs:
           # start xvfb in the background
           sudo /usr/bin/Xvfb $DISPLAY -screen 0 1280x1024x24 &
           cur=`pwd`
-          wget http://www.coppeliarobotics.com/files/CoppeliaSim_Edu_V4_1_0_Ubuntu20_04.tar.xz
+          wget https://downloads.coppeliarobotics.com/V4_1_0/CoppeliaSim_Edu_V4_1_0_Ubuntu20_04.tar.xz
           tar -xf CoppeliaSim_Edu_V4_1_0_Ubuntu20_04.tar.xz
           export COPPELIASIM_ROOT="$cur/CoppeliaSim_Edu_V4_1_0_Ubuntu20_04"
           echo $COPPELIASIM_ROOT

pyrep/robots/configuration_paths/arm_configuration_path.py

@@ -167,7 +167,8 @@ def _step_motion(self) -> int:
         if state >= 0:
             pos = posVelAccel[0]
             for i in range(len(lengths) - 1):
-                if lengths[i] <= pos <= lengths[i + 1]:
+                # Always execute the last point as pos might overshoot
+                if lengths[i] <= pos <= lengths[i + 1] or i == len(lengths) - 2:
                     t = (pos - lengths[i]) / (lengths[i + 1] - lengths[i])
                     # For each joint
                     offset = len(self._arm.joints) * i