Update on motor and leadscrew control

motor:
-added function to filter out the values
-added function to compute mecanum motor values
leadscrew:
-new way of control of leadscrew
-added back in timed up and down
Removed all camera related stuff from robot code
Fixed a NullPointerError
Inverted Motor Control and reset the shooter speed for demo