Finished GJK algorithm, began work on some mesh generating functions