Exemple #1
0
        fl.stop()
    screen.fill((0, 0, 0))

    # If client disconnects from server, reconnect
    if r.server.disconnect_counter > 0:
        r.server.receiveConnection()

    r.receive()

    data = r.datalist

    #GET TEMPERATURE DATA
    temp_data = r.getTemp(temp_data)

    #GET ACCELEROMETER DATA
    accel_data = r.getAccel(accel_data)
    a_datalist = accel_data.split(',')
    ax = a_datalist[0].strip('[')
    ay = a_datalist[1]
    az = a_datalist[2].strip(']')

    print('\n')
    print('ax =', ax)
    print('ay =', ay)
    print('az =', az)

    #GET GYROSCOPE DATA
    gyro_data = r.getGyro(gyro_data)
    g_datalist = gyro_data.split(',')
    gx = g_datalist[0].strip('[')
    gy = g_datalist[1]
# Initialize Sensor values
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'