This is work is from an assignment I did in a course on robotics. Please assume that the comments describe the instructions, and thus define my implementation. There may be other files that are referenced/called in this file but not provided. Please assume that such files were provided to me with standard implementation. This project in particular also required hard-coding values in some parts of the project, so do not mind such cases.