Crane.py and Mimic.py now are moveit based. Everything should be moving via moveit, need to make the trajectories faster by changing joint_limits.yaml or rescaling trajectories, then incorporate objects into the environment and see what happens.