Update 2

Teleop and utils updated with arm. Mux code added.