Add Scorbot 1 arm control and FZZ