collision checker bugfix
collision checker bugfix

fangeugene/trajopt,personalrobotics/trajopt,OdellDotson/trajopt,OdellDotson/trajopt,OdellDotson/trajopt,joschu/trajopt,fangeugene/trajopt,personalrobotics/trajopt,fangeugene/trajopt,personalrobotics/trajopt,joschu/trajopt,joschu/trajopt,OdellDotson/trajopt,joschu/trajopt,personalrobotics/trajopt,personalrobotics/trajopt,DeadSocks/trajopt,personalrobotics/trajopt,OdellDotson/trajopt,personalrobotics/trajopt,DeadSocks/trajopt,DeadSocks/trajopt,DeadSocks/trajopt,fangeugene/trajopt,fangeugene/trajopt,joschu/trajopt,OdellDotson/trajopt,joschu/trajopt,DeadSocks/trajopt,DeadSocks/trajopt,fangeugene/trajopt,joschu/trajopt,OdellDotson/trajopt,DeadSocks/trajopt