creating cmgaiting handle

This is based off the sensor based robotics paper algorithm