Finishing up algorithm

Have base algorithm implemented, need to put in checks for cars w/ same
HR and check pointer logic