Modifications for the schunk demo