Various Physics fixes

Signed-off-by: Chris Sanders <zidane@outlook.com>