_unsafe functions
assert that shape was cast correctly
doc
constexpr chipmunk2d defines
cast cpContactPointSet to ContactPointSet
Move static_cast to relevant section
_unsafe function