Fix zmp z to add zmp to preview queue

目標値のZMPのZ値がとんでしまっていたバグを修正しました。
よろしくお願いいたします