Your code is eventually going to control 6 motors. Will it work by exquisitely positioning them.one-at-a-time? Probably not. I expect you will need to move them in a coordinated way.
So your main loop needs to make small adjustments on every motor, every time through the loop. You need to use if() instead of while().