checking for push effects on posterior
collision testing via pose instead of joint state
made heavier so it doesnt topple so quickly
checking how much distance until the push touches and how far we could push until collision with other objects