Just pushing the current files. Going to start working on visual servoing