Square trajectory is working. Ball gripping in progress.