/*************************************************************************/
/*  world_2d.cpp                                                         */
/*************************************************************************/
/*                       This file is part of:                           */
/*                           GODOT ENGINE                                */
/*                    http://www.godotengine.org                         */
/*************************************************************************/
/* Copyright (c) 2007-2016 Juan Linietsky, Ariel Manzur.                 */
/*                                                                       */
/* Permission is hereby granted, free of charge, to any person obtaining */
/* a copy of this software and associated documentation files (the       */
/* "Software"), to deal in the Software without restriction, including   */
/* without limitation the rights to use, copy, modify, merge, publish,   */
/* distribute, sublicense, and/or sell copies of the Software, and to    */
/* permit persons to whom the Software is furnished to do so, subject to */
/* the following conditions:                                             */
/*                                                                       */
/* The above copyright notice and this permission notice shall be        */
/* included in all copies or substantial portions of the Software.       */
/*                                                                       */
/* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,       */
/* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF    */
/* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.*/
/* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY  */
/* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,  */
/* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE     */
/* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.                */
/*************************************************************************/
#include "world_2d.h"
#include "servers/visual_server.h"
#include "servers/physics_2d_server.h"
#include "servers/spatial_sound_2d_server.h"
#include "globals.h"
#include "scene/2d/visibility_notifier_2d.h"
#include "scene/main/viewport.h"
#include "scene/2d/camera_2d.h"
#include "globals.h"

struct SpatialIndexer2D {


	struct CellRef {

		int ref;

		_FORCE_INLINE_ int inc() {
			ref++;
			return ref;
		}
		_FORCE_INLINE_ int dec() {
			ref--;
			return ref;
		}

		_FORCE_INLINE_ CellRef() {
			ref=0;
		}
	};



	struct CellKey {

		union {
			struct {
				int32_t x;
				int32_t y;
			};
			uint64_t key;
		};

		bool operator==(const CellKey& p_key) const { return key==p_key.key; }
		_FORCE_INLINE_ bool operator<(const CellKey& p_key) const {
			return key < p_key.key;
		}

	};

	struct CellData {

		Map<VisibilityNotifier2D*,CellRef> notifiers;
	};


	Map<CellKey,CellData> cells;
	int cell_size;

	Map<VisibilityNotifier2D*,Rect2> notifiers;

	struct ViewportData {

		Map<VisibilityNotifier2D*,uint64_t> notifiers;
		Rect2 rect;
	};

	Map<Viewport*,ViewportData> viewports;

	bool changed;

	uint64_t pass;


	void _notifier_update_cells(VisibilityNotifier2D *p_notifier,const Rect2& p_rect,bool p_add) {

		Point2i begin = p_rect.pos;
		begin/=cell_size;
		Point2i end = p_rect.pos+p_rect.size;
		end/=cell_size;
		for(int i=begin.x;i<=end.x;i++) {

			for(int j=begin.y;j<=end.y;j++) {

				CellKey ck;
				ck.x=i;
				ck.y=j;
				Map<CellKey,CellData>::Element *E=cells.find(ck);

				if (p_add) {

					if (!E)
						E=cells.insert(ck,CellData());
					E->get().notifiers[p_notifier].inc();
				} else {

					ERR_CONTINUE(!E);
					if (E->get().notifiers[p_notifier].dec()==0) {

						E->get().notifiers.erase(p_notifier);
						if (E->get().notifiers.empty()) {
							cells.erase(E);
						}
					}
				}
			}
		}
	}

	void _notifier_add(VisibilityNotifier2D* p_notifier,const Rect2& p_rect) {

		ERR_FAIL_COND(notifiers.has(p_notifier));
		notifiers[p_notifier]=p_rect;
		_notifier_update_cells(p_notifier,p_rect,true);
		changed=true;
	}

	void _notifier_update(VisibilityNotifier2D* p_notifier,const Rect2& p_rect) {

		Map<VisibilityNotifier2D*,Rect2>::Element *E=notifiers.find(p_notifier);
		ERR_FAIL_COND(!E);
		if (E->get()==p_rect)
			return;

		_notifier_update_cells(p_notifier,p_rect,true);
		_notifier_update_cells(p_notifier,E->get(),false);
		E->get()=p_rect;
		changed=true;
	}

	void _notifier_remove(VisibilityNotifier2D* p_notifier) {

		Map<VisibilityNotifier2D*,Rect2>::Element *E=notifiers.find(p_notifier);
		ERR_FAIL_COND(!E);
		_notifier_update_cells(p_notifier,E->get(),false);
		notifiers.erase(p_notifier);

		List<Viewport*> removed;
		for (Map<Viewport*,ViewportData>::Element*F=viewports.front();F;F=F->next()) {

			Map<VisibilityNotifier2D*,uint64_t>::Element*G=F->get().notifiers.find(p_notifier);

			if (G) {
				F->get().notifiers.erase(G);
				removed.push_back(F->key());
			}
		}

		while(!removed.empty()) {

			p_notifier->_exit_viewport(removed.front()->get());
			removed.pop_front();
		}

		changed=true;
	}

	void _add_viewport(Viewport* p_viewport,const Rect2& p_rect) {

		ERR_FAIL_COND(viewports.has(p_viewport));
		ViewportData vd;
		vd.rect=p_rect;
		viewports[p_viewport]=vd;
		changed=true;

	}

	void _update_viewport(Viewport* p_viewport, const Rect2& p_rect) {

		Map<Viewport*,ViewportData>::Element *E= viewports.find(p_viewport);
		ERR_FAIL_COND(!E);
		if (E->get().rect==p_rect)
			return;
		E->get().rect=p_rect;
		changed=true;
	}

	void _remove_viewport(Viewport* p_viewport) {
		ERR_FAIL_COND(!viewports.has(p_viewport));
		List<VisibilityNotifier2D*> removed;
		for(Map<VisibilityNotifier2D*,uint64_t>::Element *E=viewports[p_viewport].notifiers.front();E;E=E->next()) {

			removed.push_back(E->key());
		}

		while(!removed.empty()) {
			removed.front()->get()->_exit_viewport(p_viewport);
			removed.pop_front();
		}

		viewports.erase(p_viewport);
	}

	void _update() {


		if (!changed)
			return;

		for (Map<Viewport*,ViewportData>::Element *E=viewports.front();E;E=E->next()) {

			Point2i begin = E->get().rect.pos;
			begin/=cell_size;
			Point2i end = E->get().rect.pos+E->get().rect.size;
			end/=cell_size;
			pass++;
			List<VisibilityNotifier2D*> added;
			List<VisibilityNotifier2D*> removed;

			int visible_cells=(end.x-begin.x)*(end.y-begin.y);

			if (visible_cells>10000) {

				//well you zoomed out a lot, it's your problem. To avoid freezing in the for loops below, we'll manually check cell by cell

				for (Map<CellKey,CellData>::Element *F=cells.front();F;F=F->next()) {

					const CellKey &ck=F->key();

					if (ck.x<begin.x || ck.x>end.x)
						continue;
					if (ck.y<begin.y || ck.y>end.y)
						continue;

					//notifiers in cell
					for (Map<VisibilityNotifier2D*,CellRef>::Element *G=F->get().notifiers.front();G;G=G->next()) {

						Map<VisibilityNotifier2D*,uint64_t>::Element *H=E->get().notifiers.find(G->key());
						if (!H) {

							H=E->get().notifiers.insert(G->key(),pass);
							added.push_back(G->key());
						} else {
							H->get()=pass;
						}
					}
				}

			} else {

				//check cells in grid fashion
				for(int i=begin.x;i<=end.x;i++) {

					for(int j=begin.y;j<=end.y;j++) {

						CellKey ck;
						ck.x=i;
						ck.y=j;

						Map<CellKey,CellData>::Element *F=cells.find(ck);
						if (!F) {
							continue;
						}


						//notifiers in cell
						for (Map<VisibilityNotifier2D*,CellRef>::Element *G=F->get().notifiers.front();G;G=G->next()) {

							Map<VisibilityNotifier2D*,uint64_t>::Element *H=E->get().notifiers.find(G->key());
							if (!H) {

								H=E->get().notifiers.insert(G->key(),pass);
								added.push_back(G->key());
							} else {
								H->get()=pass;
							}
						}
					}
				}
			}

			for (Map<VisibilityNotifier2D*,uint64_t>::Element *F=E->get().notifiers.front();F;F=F->next()) {

				if (F->get()!=pass)
					removed.push_back(F->key());
			}

			while(!added.empty()) {
				added.front()->get()->_enter_viewport(E->key());
				added.pop_front();
			}

			while(!removed.empty()) {
				E->get().notifiers.erase(removed.front()->get());
				removed.front()->get()->_exit_viewport(E->key());
				removed.pop_front();
			}
		}

		changed=false;
	}


	SpatialIndexer2D() {

		pass=0;
		changed=false;
		cell_size=100; //should be configurable with GLOBAL_DEF("") i guess
	}

};



void World2D::_register_viewport(Viewport* p_viewport,const Rect2& p_rect) {

	indexer->_add_viewport(p_viewport,p_rect);
}

void World2D::_update_viewport(Viewport* p_viewport,const Rect2& p_rect){

	indexer->_update_viewport(p_viewport,p_rect);

}
void World2D::_remove_viewport(Viewport* p_viewport){

	indexer->_remove_viewport(p_viewport);
}

void World2D::_register_notifier(VisibilityNotifier2D* p_notifier, const Rect2 &p_rect){

	indexer->_notifier_add(p_notifier,p_rect);

}
void World2D::_update_notifier(VisibilityNotifier2D* p_notifier,const Rect2& p_rect){

	indexer->_notifier_update(p_notifier,p_rect);
}
void World2D::_remove_notifier(VisibilityNotifier2D* p_notifier){

	indexer->_notifier_remove(p_notifier);
}

void World2D::_update() {

	indexer->_update();
}


RID World2D::get_canvas() {

	return canvas;
}

RID World2D::get_space() {

	return space;
}

RID World2D::get_sound_space() {

	return sound_space;
}

void World2D::_bind_methods() {

	ObjectTypeDB::bind_method(_MD("get_canvas"),&World2D::get_canvas);
	ObjectTypeDB::bind_method(_MD("get_space"),&World2D::get_space);
	ObjectTypeDB::bind_method(_MD("get_sound_space"),&World2D::get_sound_space);

	ObjectTypeDB::bind_method(_MD("get_direct_space_state:Physics2DDirectSpaceState"),&World2D::get_direct_space_state);

}

Physics2DDirectSpaceState *World2D::get_direct_space_state() {

	return Physics2DServer::get_singleton()->space_get_direct_state(space);
}


World2D::World2D() {

	canvas = VisualServer::get_singleton()->canvas_create();
	space = Physics2DServer::get_singleton()->space_create();
	sound_space = SpatialSound2DServer::get_singleton()->space_create();

	//set space2D to be more friendly with pixels than meters, by adjusting some constants
	Physics2DServer::get_singleton()->space_set_active(space,true);
	Physics2DServer::get_singleton()->area_set_param(space,Physics2DServer::AREA_PARAM_GRAVITY,GLOBAL_DEF("physics_2d/default_gravity",98));
	Physics2DServer::get_singleton()->area_set_param(space,Physics2DServer::AREA_PARAM_GRAVITY_VECTOR,GLOBAL_DEF("physics_2d/default_gravity_vector",Vector2(0,1)));
	// TODO: Remove this deprecation warning and compatibility code for 2.2 or 3.0
	if (Globals::get_singleton()->get("physics_2d/default_density") && !Globals::get_singleton()->get("physics_2d/default_linear_damp)")) {
		WARN_PRINT("Deprecated parameter 'physics_2d/default_density'. It was renamed to 'physics_2d/default_linear_damp', adjusting your project settings accordingly (make sure to adjust scripts that potentially rely on 'physics_2d/default_density'.");
		Globals::get_singleton()->set("physics_2d/default_linear_damp", Globals::get_singleton()->get("physics_2d/default_density"));
		Globals::get_singleton()->set_persisting("physics_2d/default_linear_damp", true);
		Globals::get_singleton()->set_persisting("physics_2d/default_density", false);
		Globals::get_singleton()->save();
	}
	Physics2DServer::get_singleton()->area_set_param(space,Physics2DServer::AREA_PARAM_LINEAR_DAMP,GLOBAL_DEF("physics_2d/default_linear_damp",0.1));
	Physics2DServer::get_singleton()->area_set_param(space,Physics2DServer::AREA_PARAM_ANGULAR_DAMP,GLOBAL_DEF("physics_2d/default_angular_damp",1));
	Physics2DServer::get_singleton()->space_set_param(space,Physics2DServer::SPACE_PARAM_CONTACT_RECYCLE_RADIUS,1.0);
	Physics2DServer::get_singleton()->space_set_param(space,Physics2DServer::SPACE_PARAM_CONTACT_MAX_SEPARATION,1.5);
	Physics2DServer::get_singleton()->space_set_param(space,Physics2DServer::SPACE_PARAM_BODY_MAX_ALLOWED_PENETRATION,0.3);
	Physics2DServer::get_singleton()->space_set_param(space,Physics2DServer::SPACE_PARAM_BODY_LINEAR_VELOCITY_SLEEP_TRESHOLD,2);
	Physics2DServer::get_singleton()->space_set_param(space,Physics2DServer::SPACE_PARAM_CONSTRAINT_DEFAULT_BIAS,0.2);

	indexer = memnew( SpatialIndexer2D );

}


World2D::~World2D() {

	VisualServer::get_singleton()->free(canvas);
	Physics2DServer::get_singleton()->free(space);
	SpatialSound2DServer::get_singleton()->free(sound_space);
	memdelete(indexer);
}