fix bug when excluding grabbed collisions
change collision penalties after fixing trajopt cylinder half-extents