Added twist to odom, fixed compiler errors