#!/bin/bash
target/debug/herkulex_communicator message ForceSetId --setid $1 --output /dev/ttyUSB0 --id 254
sleep 0.1
target/debug/herkulex_communicator message reboot --output /dev/ttyUSB0 --id 254
sleep 0.1
target/debug/herkulex_communicator message enabletorque --output /dev/ttyUSB0 --id $1
sleep 0.3
target/debug/herkulex_communicator message setposition --position 21 --output /dev/ttyUSB0 --id $1
sleep 1
target/debug/herkulex_communicator message setposition --position 1002 --output /dev/ttyUSB0 --id $1
sleep 1
target/debug/herkulex_communicator message setposition --position 512 --output /dev/ttyUSB0 --id $1