Advanced Robot Motion for Surface Quality in 3D