merge cone compare run_ci

Author: thowell

examples/animations/cone_compare_mujoco.gif

@@ -0,0 +1,20 @@
+# ## Ghost
+set_camera!(vis, cam_pos=[-1,1,0], zoom=1)
+
+z_sim = get_maximal_state(storage)
+timesteps = [5, 10, 15]# .+ 150
+
+for t in timesteps
+    name = Symbol("robot_$t")
+    build_robot(mech, vis=vis, name=name, color= magenta_light)
+    z = z_sim[t]
+    set_robot(vis, mech, z, name=name)
+end
+
+z_sim[220][1] -= 0.1
+z_sim[220][13 + 1] -= 0.05
+set_robot(vis, mech, z_sim[220])
+
+z_sim[104][1] -= 0.025
+z_sim[104][13 + 1] -= 0.05
+set_robot(vis, mech, z_sim[104])

examples/animations/cone_compare_mujoco.mp4

@@ -88,29 +88,62 @@ vis, anim = visualize(mech_nc, storage_nc,
     name=:nc,
     animation=anim)
 
-# ## MuJoCo cone
-color_mj = magenta;
+# ## MuJoCo pyramidal cone
+color_mjlc = magenta;
 
-mech_mj = get_mechanism(:box,
+mech_mjlc = get_mechanism(:box,
     timestep=timestep,
     gravity=gravity,
     friction_coefficient=friction_coefficient,
     contact_type=:linear,
-    mode=:box, color=color_mj);
+    mode=:box, color=color_mjlc);
 
 # ## Load
-initialize!(mech_mj, :box,
+initialize!(mech_mjlc, :box,
     x=x0,
     q=one(UnitQuaternion),
     v=v0,
     ω=ω0)
-file = jldopen(joinpath(@__DIR__, "../MuJoCo_benchmark/results/cone_compare.jld2"))
-storage_mj = generate_storage(mech_mj, [get_maximal_state(mech_mj), file["ztraj"]...])
+file = jldopen(joinpath(@__DIR__, "../mujoco_benchmark/results/cone_compare_pyramidal.jld2"))
+storage_mjlc = generate_storage(mech_mjlc, [get_maximal_state(mech_mjlc), file["ztraj"]...])
 
 # ## Visualize
-vis, anim = visualize(mech_mj, storage_mj,
+vis, anim = visualize(mech_mjlc, storage_mjlc,
     vis=vis,
-    name=:mj,
+    name=:mjlc,
     animation=anim)
 
+line_mat_mjlc = LineBasicMaterial(color=color_mjlc, linewidth=25.0)
+points_mjlc = Vector{Point{3,Float64}}()
+for (i, xt) in enumerate(storage_mjlc.x[1])
+    k = xt
+    push!(points_mjlc, Point(k[1], k[2], k[3]))
+end
+setobject!(vis[:path_mjlc], MeshCat.Line(points_mjlc, line_mat_mjlc))
+
+
+# ## MuJoCo elliptic cone
+color_mjnc = RGBA(0,0,0);
+
+mech_mjnc = get_mechanism(:box,
+    timestep=timestep,
+    gravity=gravity,
+    friction_coefficient=friction_coefficient,
+    contact_type=:linear,
+    mode=:box, color=color_mjnc);
+
+# ## Load
+initialize!(mech_mjnc, :box,
+    x=x0,
+    q=one(UnitQuaternion),
+    v=v0,
+    ω=ω0)
+file = jldopen(joinpath(@__DIR__, "../mujoco_benchmark/results/cone_compare_elliptic.jld2"))
+storage_mjnc = generate_storage(mech_mjnc, [get_maximal_state(mech_mjnc), file["ztraj"]...])
+
+# ## Visualize
+vis, anim = visualize(mech_mjnc, storage_mjnc,
+    vis=vis,
+    name=:mjnc,
+    animation=anim)