arrowkeysL = pygame.image.load(dirpath + '/arrowkeysL.png')
arrowkeysR = pygame.image.load(dirpath + '/arrowkeysR.png')
arrowkeysUp = pygame.image.load(dirpath + '/arrowkeysUp.png')
arrowkeysDown = pygame.image.load(dirpath + '/arrowkeysDown.png')
arrowkeysUL = pygame.image.load(dirpath + '/arrowkeysUL.png')
arrowkeysUR = pygame.image.load(dirpath + '/arrowkeysUR.png')
arrowkeysDL = pygame.image.load(dirpath + '/arrowkeysDL.png')
arrowkeysDR = pygame.image.load(dirpath + '/arrowkeysDR.png')
joytop = pygame.image.load(dirpath + '/joysticktopSmall.png')
joybase = pygame.image.load(dirpath + '/joystickbase_250.png')
# Do not use convert for the following images
#------------------------- Button images -------------------------------
posarrows = (815, 620)
arrow = np.array([[2, 0], [2, 150], [7, 150], [0, 165], [-7, 150], [-2, 150],
[-2, 0], [2, 0]])
textPrint = pgt.TextPrint(pygame.Color('white'))
axis0 = 0
mx_origin, my_origin = 500, 540
mxnew, mynew = 250, 250
framecount = 1
done = False
xdatarange = [760, 950]
y_origin = 450
yscale = 100
pts = deque(maxlen=xdatarange[1] - xdatarange[0])
pts2 = deque(maxlen=xdatarange[1] - xdatarange[0])
for ii in range(xdatarange[0], xdatarange[1]):
pts.appendleft((ii, 0))
pts2.appendleft((ii, 0))
iii = 200
from datetime import datetime
#-----------------------------------------------------------------------
# Setup display and objects for drawing
#-----------------------------------------------------------------------
geom = geometry.geometry()
pygame.init()
screen = pygame.display.set_mode((1000, 700))
pygame.display.set_caption("Pendulum")
clock = pygame.time.Clock()
framerate = 60
origin = [500,180]
arrow = np.array([[1,0],[1,150],[0,152],[-1,150],[-1,0],[1,0]]).astype(float)
arrow = arrow/arrow.max()
scalefactor = 240
sbar = pgt.SliderBar(screen, (100,100), 1, 800, 2.00, 10, (170,170,170),(10,10,10),20)
textPrint = pgt.TextPrint((255,255,255))
textPrint.setfontsize(30)
#-----------------------------------------------------------------------
# Constants
#-----------------------------------------------------------------------
g = 9.81
l = 1
alpha = 0
omega = 0
theta = 0.9*np.pi
dt = 1.0/framerate
C = 1
internal_loops = 10
dt = dt / internal_loops
#-----------------------------------------------------------------------
pygame.display.set_caption("Player 1")
#---------- Loop until the user clicks the close button ---------------#
done = False
#---------- Used to manage how fast the screen updates ---------------#
clock = pygame.time.Clock()
#------------------ Initialize the joysticks -------------------------#
pygame.joystick.init()
#----------------------- Print to Window -----------------------------#
textPrint = pgt.TextPrint(WHITE)
# ---------------------- Main Program Loop ----------------------------#
while not done:
for event in pygame.event.get(): # User did something.
if event.type == pygame.QUIT: # If user clicked close.
done = True # Flag that we are done so we exit this loop.
btcom.connect(0)
print('Connection Closed')
if event.type == KEYDOWN and event.key == K_q:
btcom.connect(0)
pygame.display.quit()
sys.exit()
print('Connection Closed')
