예제 #1
0
    rc.ResetEncoderCnts(0x81)

    # start all motors
    rc.M2Forward(r1_address,speed)
    rc.M1Forward(r2_address,speed)
    rc.M1Forward(r3_address,speed)

    time.sleep(seconds)

    # stop all motors
    rc.M2Forward(r1_address,0)
    rc.M1Forward(r2_address,0)
    rc.M1Forward(r3_address,0)

    r1_ticks_per_second = rc.readM2encoder(r1_address)[0]/seconds
    r2_ticks_per_second = rc.readM1encoder(r2_address)[0]/seconds
    r3_ticks_per_second = rc.readM1encoder(r3_address)[0]/seconds

    print speed, r1_ticks_per_second, r2_ticks_per_second, r3_ticks_per_second

# speed     ticks/second (r1, r2, r3)
# 5         6565 7316 7206
# 10        14103 15410 15189
# 15        21744 23391 23160
# 20        29412 31361 31187
# 25        37284 38919 39325
# 30        45164 46916 47410
# 35        53177 55065 55714
# 40        61693 63290 64199
# 45        70002 71671 72669
# 50        78266 80219 81127
예제 #2
0
파일: circle.py 프로젝트: jar3dp/ecen490
print starting

# stop all motors
rc.M2Forward(r1_address,0)
rc.M1Forward(r2_address,0)
rc.M1Forward(r3_address,0)
rc.ResetEncoderCnts(0x80)
rc.ResetEncoderCnts(0x81)

# start all motors
rc.M2Forward(r1_address,speed)
rc.M1Forward(r2_address,speed)
rc.M1Forward(r3_address,speed)

while rc.readM1encoder(r2_address)[0] <= stop_ticks:
    continue

# stop all motors
rc.M2Forward(r1_address,0)
rc.M1Forward(r2_address,0)
rc.M1Forward(r3_address,0)
rc.ResetEncoderCnts(0x80)
rc.ResetEncoderCnts(0x81)

print rc.readM1encoder(0x81)[0] - circle_ticks * num_circles

# speed     splipage
# 15        179, 187, 129       11
# 50        648, 616, 524       11.92
# 100       1067, 955, 885      9.69
예제 #3
0
파일: test.py 프로젝트: jar3dp/ecen490
import roboclaw as rc
import serial


#rc.M1Forward(0x80,0)
# rc.M1Forward(0x81,0)
# rc.M2Forward(0x80,0)
# rc.M1Forward(0x80,0)


while 1:
    print rc.readM1encoder(0x81)


# rc.M2Forward(0x80, 10)

#Get version string
# rc.sendcommand(128,21)
# rcv = port.read(32)
# print repr(rcv)
#
# rc.sendcommand(129,90)
# rcv = port.read(1)
# print repr(rcv)