MADE:
--> Realized that time was wrong all the time.
--> Added 3D line plot of the trajectory