The elevator control has a lot of manual feedforward calculations. Instead, set up a Elevator Feedforward object to use
Additionally, to make smooth movements that use the feedforward model, create a ProfiledPIDController that will create a trapezoidal motion profile for your elevator to follow