建立两个routine

在init 程序里，设置xyz方向个数和各方向间距

在p_main程序里，创建机器人移动到pHome点，pPick位置（抓取位置），以及**个放置点pPlace_ini

通过三层for循环，进行码垛。实例程序为先x方向，再y方向，再z方向