Cool ideas!
For the first person mode: I think the better fix is to make the camera not allowed to go through walls. It's a pretty standard third person camera thing, that I just haven't gotten to yet.