#M111
#!/bin/bash
# file to turn on right side clamps in sequence
clamp=${1%.*}
unclamp=${2%.*}
echo "unclamp is $unclamp"
RT_PIN_VALUE=$(halcmd getp conv-float-u32.1.in)

if [ "$RT_PIN_VALUE" = "$clamp" ]; then
     echo "already clamped exiting"
     exit 0
fi

mask1=$(( (clamp & 24) | unclamp ))
mask2=$(( (clamp & 3) | unclamp ))
mask3=$(( (clamp & 27) | unclamp ))

halcmd sets right-clamp-fl $mask1
sleep .500 ;# wait for clamps to move
halcmd sets right-clamp-fl $unclamp
sleep .500 ;# wait for clamps to move
halcmd sets right-clamp-fl $mask2
sleep .500 ;# wait for clamps to move
halcmd sets right-clamp-fl $unclamp
sleep .500 ;# wait for clamps to move
halcmd sets right-clamp-fl $mask3
sleep .500 ;# wait for clamps to move
halcmd sets right-clamp-fl $clamp

exit 0

