Updated config on main teleop

Also a helpful diagram has been included