예제 #1
0
sonarAccelorationResults = []

#touch = Touch(brick, PORT_4)


robot = Robot() # new nerve object for reading and controlling the motors and sensors

    
#robot.resetMotors()     # resets the tachometer
initialPosition = robot.sonarReading()
robot.move()           # moves the robot



for i in range(steps):   
    robot.motorPosition()
    robot.motorVelocity(sleepytime)
    robot.motorAcceloration(sleepytime)
   
    robot.sonarReading()    
    robot.sonarVelocity(sleepytime)
    robot.sonarAcceloration(sleepytime)
   
    print robot.currentMotorPosition, robot.currentMotorVelocity, robot.currentMotorAcceloration
    print robot.currentSonarReading, robot.currentSonarVelocity, robot.currentSonarAcceloration 
    print ' '
    
    sonarPositionResults.append(robot.currentSonarReading)
    sonarVelocityResults.append(robot.currentSonarVelocity)
    sonarAccelorationResults.append(robot.currentSonarAcceloration)