Many changes, committing for the day. Prototype robot working except elevator has not yet been implemented.