change init pos in slam
minor work
add making data
work sample