working g500 in gazebo, fixing it up still