-added scripts to record and reach positions
-filter erroneous joint states