Pose Coding

#!/usr/bin/env python3

# This file generated by Linkbot Labs Pose Coding

from linkbot import Linkbot

linkbot{{$index+1}} = Linkbot('{{r._id | uppercase}}')

linkbot{{$index+1}}.setJointSpeeds({{m.speeds[$index][0] |number:1}}, {{m.speeds[$index][1] |number:1}}, {{m.speeds[$index][2] |number:1}})

while True:

    # Pose {{$index+1}} 
    linkbot{{$index+1}}.moveToNB({{pose[$index][0] |number:1}}, {{pose[$index][1] |number:1}}, {{pose[$index][2] |number:1}})
    linkbot{{$index+1}}.moveWait()
    linkbot{{$index+1}}.moveTo({{pose[$index][0] |number:1}}, {{pose[$index][1] |number:1}}, {{pose[$index][2] |number:1}})

    break