Add hacky interpenetration resolution