Redid the directory structure to have matlab script subfolders, added initial gradient computation, and also added initial antipodal grasp point optimization