Added feet variable for AI to step over stairs and on foundations (TODO: IK?) Refactored and tweaked some AI calculations Updated AI test scene