Replaced keyboard teleop program
Updated arduino code
Fixed drive joint parameters