DogWormVRC3
* Added "close hands command"
* Added AddRotation(0) when turning off the bearing fb
* Changed the sequence functions so they allow for sequences of different lengths

seq_generator
* Human-like crab walking, is more robust on hills, still needs some work

Signed-off-by: Darpa Tech 3 <darpa3@SMILe03.(none)>
* Added launch and world files for vrc_task_2 and playground
* Added MATLAB file to create the playground height map

DogWormVRC3
* Added function+command for head pitch control
* Added parameter to chose between rotation modes
* Added command for single rotation
* Added command to reset pose
* Added "status" command to display all the command-line flags:
   Bearing FB, Des. bearing, Terrain type, Rot. mode
* Wrapped JC.send_pos_traj inside send_pos_traj to easily include the head pitch
* Implemented the RotFlag to smoothly transfer between sequences (FWD, BWD, ROTATE)
* Improved bearing response for FWD crawl
* Revamped fast RotateOnSpot sequence
   Use knee0 parameter for slow, tight turn or fast, wide turn
* Started work on RotOnMud sequence, needs more work
* Improved all recovery functions from tipping

seq_generator
* Small changes to FWD crawling gait
* Moved last step of BWD sequence to the beginning of the sequence for smoothness

Signed-off-by: Darpa Tech 3 <darpa3@SMILe03.(none)>
DogWormVRC3
* added Vector3 dependency to publish robot's orientation
* Wrote down all the commands into a list
* Added a "command" and "help" function for the console
* Reduced max back turn (bearing response) for stability
* Finished improving RotOnMud sequence. Still could be better...
* Added RotFlag = 1 after recovery for smoother transition to fwd
* Improved side tipping function. Still could be better...
  (arms are weak sometimes, overall is quite robust)
* Worked a bit on front recovery, still not 100% robust
* Started working on stand-up function.
  Recorded some videos of the motion including IMU data.
  If feedback is added it could greatly improve robustness.
* Added workaround for "hands not closing on start-up" bug

IMU_monitoring
* Removed annoying "count_stand" message

seq_generator
* Minor changes to sit-down, fwd and bwd sequences

Signed-off-by: Darpa Tech 3 <darpa3@SMILe03.(none)>
added GPlugin enabled world, now depends on GPlugin package

Signed-off-by: izzys <izzy.schall@gmail.com>
* Solved reset pose bug
* Increased wrist P gain
* Small changes to improve FWD seq

Signed-off-by: Darpa Tech 3 <darpa3@SMILe03.(none)>
Merge branch 'GPlugin'
DogWormVRC3
* Added gravity plugin + command
* Added command to control knee extension during fast rotation
* Improved implementation of knee extension during fast rotation
* Added command to control the throttle (speed) for each sequence individually (FWD, BWD, Fast rot, Slow rot)
* Updated "seq step" command to go straight to the desired step instead of through the sequence
* Improved back/side tipping recovery

seq_generator
* Added "pelvis height" parameter to bwd crawling sequence

Signed-off-by: Darpa Tech 3 <darpa3@SMILe03.(none)>