Implementation of shape_query and bb_query functions

I have implemented shape_query and bb_query functions which was missed in the cymunk