# -*- encoding=utf-8 -*-
# 	Burak ER
#	burak.er@btu.edu.tr
# 	github.com/burak-er
#	Mechanical Engineering Department
#	Bursa Technical University
#
import matplotlib

matplotlib.use('Qt5Agg')

# Use an integrator engine that is derived from the interface Integrator.

#RungeKuttaCashKarp54Integrator integrator performs one step of simulation for the given tolerances. Whether the time step is given, it completes it then stops.

integrator = RungeKuttaCashKarp54Integrator(
        [
                ForceResetter(),
                GeneralIntegratorInsertionSortCollider([Bo1_Sphere_Aabb(), Bo1_Box_Aabb()]),
                InteractionLoop(
                        [Ig2_Sphere_Sphere_ScGeom(), Ig2_Box_Sphere_ScGeom()], [Ip2_FrictMat_FrictMat_FrictPhys()], [Law2_ScGeom_FrictPhys_CundallStrack()]
                ),
                GravityEngine(gravity=Vector3(0, 0, -9.81)),
                PyRunner(virtPeriod=1e-99, command='myAddPlotData()')  #use virtPeriod on this integrator.
        ]
)

#Tolerances can be set for the optimum accuracy
integrator.rel_err = 1e-6
integrator.abs_err = 1e-6

O.engines = [
        integrator,
]

O.bodies.append(box(center=[0, 0, 0], extents=[.5, .5, .5], fixed=True, color=[1, 0, 0]))
O.bodies.append(sphere([0, 0, 2], 1, color=[0, 1, 0]))
O.dt = 1e-2  # this signifies the endpoint. It is not much important for the accuracy of the integration where accuracy is defined by rel_err and abs_err of the integrator.

############################################
##### now the part pertaining to plots #####
############################################

from yade import plot
## we will have 2 plots:
## 1. t as function of i (joke test function)
## 2. i as function of t on left y-axis ('|||' makes the separation) and z_sph, v_sph (as green circles connected with line) and z_sph_half again as function of t
plot.plots = {'i': ('t'), 't': ('z_sph', None, ('v_sph', 'go-'), 'z_sph_half')}


## this function is called by plotDataCollector
## it should add data with the labels that we will plot
## if a datum is not specified (but exists), it will be NaN and will not be plotted
def myAddPlotData():
	sph = O.bodies[1]
	## store some numbers under some labels
	plot.addData(t=O.time, i=O.iter, z_sph=sph.state.pos[2], z_sph_half=.5 * sph.state.pos[2], v_sph=sph.state.vel.norm())


print("Now calling plot.plot() to show the figures. The timestep is artificially low so that you can watch graphs being updated live.")
plot.liveInterval = .2
plot.plot(subPlots=False)
print("Number of threads ", os.environ['OMP_NUM_THREADS'])
O.run(int(5. / O.dt))
#plot.saveGnuplot('/tmp/a')
## you can also access the data in plot.data['i'], plot.data['t'] etc, under the labels they were saved.
