| #!/usr/bin/env python | |||||
| import os | |||||
| def sb_write(fd, servo, pulse): | |||||
| try: | |||||
| os.write(fd, '%d=%d\n' % (servo,pulse)) | |||||
| except IOError as e: | |||||
| print e | |||||
| try: | |||||
| fd = os.open('/dev/servoblaster', os.O_WRONLY) | |||||
| except OSError as e: | |||||
| print 'could not open /dev/servoblaster' | |||||
| raise SystemExit(5) | |||||
| except (KeyboardInterrupt, SystemExit): | |||||
| os.close(fd) | |||||
| pass | |||||
| delta = 1.0 / 50 | delta = 1.0 / 50 | ||||
| print("({},{} --> {})".format(car.speed_cur, car.angle_cur, (car.speed_cur - car.speed_last) / delta)) + ", Servo_active: " + str(car.is_testmode_servo_active) + "CC Speed: " str(car.speed_cruise_control) | print("({},{} --> {})".format(car.speed_cur, car.angle_cur, (car.speed_cur - car.speed_last) / delta)) + ", Servo_active: " + str(car.is_testmode_servo_active) + "CC Speed: " str(car.speed_cruise_control) | ||||
| sleep(1 / 50) | |||||
| except KeyboardInterrupt: | except KeyboardInterrupt: | ||||
| print "Exiting through keyboard event (CTRL + C)" | print "Exiting through keyboard event (CTRL + C)" |