make elevator move to setpoints + tuning
make elevator move to setpoints + tuning