Initial commit. Has the majority of the code but needs more integration testing between robot and computer.