Increased controller wait time
Added ability for cuff squeeze to update trajectory controller
Added counter