fix generate msg
add grasp offset