Adding collisions and kinematics code to automated port placement repo