Updated for current robot

Changes from first qualifiers