If you essentially just translate your matlab code into URScript, you can then feed the positions into the servoj command (after converting to joint angles using get_inverse_kin() ) :
You can set the TCP orientation as [0,0,0] for all positions to keep the tool pointing upwards throughout the movement.
