Did some work on thinning out line families so we can remove some uneccassary lines
Created headder and cpp file for the heapsort algorithm that will help sort
the line_family vector so that it can be processed to remove duplicates.
Also implemented a quicksort algorithm to use until we get heapsort working.
merge with josh
Modified the robot arm program to compensate for the third installed motor.