robot1 = Fresonbot() # Using Fresonbot class
# Use it variable to describe your trajectory ([x1,y2,x2,y2,....,xn,yn])
-it = iter([400,0,400,400,0,400,200,200,0,0,400,0,400,400,0,400,200,200,0,0])
+#it = iter([400,0,400,400,0,400,200,200,0,0,400,0,400,400,0,400,200,200,0,0])
#it = iter([400,0,400,400,0,400,200,200,0,0])
#it = iter([200,0,200,200,0,200,0,0])
+it = iter([100,0,100,100,0,100,0,0])
#it = iter([200,100])
# PID constants
#!/bin/bash
left_slot="bone_eqep1"
-right_slot="bone_eqep2b"
+right_slot="bone_eqep2"
if grep -q bone_eqep1 /sys/devices/bone_capemgr.9/slots; then
echo "left slot already enabled"
echo bone_eqep1 > /sys/devices/bone_capemgr.9/slots
fi
-if grep -q bone_eqep2b /sys/devices/bone_capemgr.9/slots; then
+if grep -q bone_eqep2 /sys/devices/bone_capemgr.9/slots; then
echo "right slot already enabled"
else
- echo bone_eqep2b > /sys/devices/bone_capemgr.9/slots
+ echo bone_eqep2 > /sys/devices/bone_capemgr.9/slots
fi