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