Beispiel #1
0
    gyro_data = r.getGyro(gyro_data)
    g_datalist = gyro_data.split(',')
    gx = g_datalist[0].strip('[')
    gy = g_datalist[1]
    if 'sonar' in g_datalist[2]:
        gz = g_datalist[2].strip(']sonar')
    else:
        gz = g_datalist[2].strip(']')

    print('\n')
    print('gx =', gx)
    print('gy =', gy)
    print('gz =', gz)

    #GET SONAR DATA
    sonar_data = r.getSonar(sonar_data)

    print('\n')
    print('temp = ', temp_data)
    print('sonar = ', sonar_data)

    time.sleep(.1)
    '''

    if control == 'forward':
        robot.direction = 'up'
        bl.forward()
        y_change = -2

    elif control == 'backward':
        robot.direction = 'down'
accel = 0
sonar = 0
imu = 0

running = True
while running:

    screen.fill((0, 0, 0))

    if r.server.disconnect_counter == 1:
        r.server.receiveConnection()

    r.receive()

    accel = r.getAccel(accel)
    sonar = r.getSonar(sonar)
    imu = r.getIMU(imu)
    '''

    if control == 'forward':
        robot.direction = 'up'
        y_change = -2
    elif control == 'backward':
        robot.direction = 'down'
        y_change = 2
    elif control == 'left':
        robot.direction = 'left'
        x_change = -2
    elif control == 'right':
        robot.direction = 'right'
        x_change = 2