UPDATE | Finished Code

Changed motor values, final change before competition