Fix Some Sleeping Body Bugs

Wake up bodies which are near other moving bodies to prevent bodies from sleeping when they shouldn't be. For example on top of another body which then moves.