provides very minimal SDF support 

should be easy to implement many of the features that I skipped over now that the basics work.

It looks we think that the body with non-positive index is always world. I thought frame can also have negative index. Is this possible that it finds a frame index?