def start_sending_rowing_info(self):
machines = list(pyrow.find())
if len(machines) > 0:
rowing_machine = machines[0]
erg = pyrow.pyrow(rowing_machine)
while self.is_open:
monitor = erg.get_monitor(forceplot=True)
message = json.dumps(monitor).encode('utf8')
try:
self.sendMessage(message, isBinary=False)
except:
print("couldn't send message")
yield from asyncio.sleep(2)
else:
print('No machines connected')
def setup_device(self ):
# TODO: Clean up previous devices etc.
while True:
failed_once = False
try:
devices = pyrow.find()
if len(devices) == 0:
raise Error("No device found")
self.erg = pyrow.pyrow(devices[0])
self.log.info("device connected")
break
except Exception as e:
if self.once:
raise
else:
if not failed_once:
self.log.error( "failed to setup device: " + str(e) + " (retrying)" )
failed_once = True
sleep.time(1)
def just_row():
ergs = list(pyrow.find())
while len(ergs) == 0:
ergs = list(pyrow.find())
erg = pyrow.pyrow(ergs[0])
print "Connected to erg."
workout = erg.get_workout()
print "Waiting for workout to start ..."
while workout['state'] == 0:
time.sleep(1)
workout = erg.get_workout()
print "Workout has begun"
while workout['state'] == 1:
pace_input = erg.send(['CSAFE_GETPACE_CMD', ])
pace_output = "Stroke Pace = " + str(pace_input['CSAFE_GETPACE_CMD'][0] / 2)
duration_input = erg.send(['CSAFE_PM_GET_WORKTIME', ])
duration_output = "Duration = " + str(duration_input['CSAFE_PM_GET_WORKTIME'][0])
distance_input = erg.send(['CSAFE_GETHORIZONTAL_CMD', ])
distance_output = "Distance = " + str(distance_input['CSAFE_GETHORIZONTAL_CMD'][0])
power_input = erg.send(['CSAFE_GETPOWER_CMD', ])
power_output = "Power = " + str(power_input['CSAFE_GETPOWER_CMD'][0])
calories_input = erg.send(['CSAFE_GETCALORIES_CMD', ])
calories_output = "Calories = " + str(calories_input['CSAFE_GETCALORIES_CMD'][0])
heartrate_input = erg.send(['CSAFE_GETHRCUR_CMD', ])
heartrate_output = "Heart Rate = " + str(heartrate_input['CSAFE_GETHRCUR_CMD'][0])
cadence_input = erg.send(['CSAFE_GETCADENCE_CMD', ])
cadence_output = "Cadence = " + str(cadence_input['CSAFE_GETCADENCE_CMD'][0])
print (pace_output, duration_output, distance_output, power_output, calories_output, heartrate_output, cadence_output)
import pyrow
import time
if __name__ == '__main__':
#Connecting to erg
ergs = list(pyrow.find())
if len(ergs) == 0:
exit("No ergs found.")
erg = pyrow.pyrow(ergs[0])
print("Connected to erg.")
#Open and prepare file
write_file = open('workout.csv', 'w')
write_file.write('Time, Distance, SPM, Pace, Force Plot\n')
#Loop until workout has begun
workout = erg.get_workout()
print("Waiting for workout to start ...")
while workout['state'] == 0:
time.sleep(1)
workout = erg.get_workout()
print("Workout has begun")
#Loop until workout ends
while workout['state'] == 1:
forceplot = erg.get_force_plot()
#Loop while waiting for drive
while forceplot['strokestate'] != 2 and workout['state'] == 1:
#Licensed under the Simplified BSD License.
#This is an example file to show how to make use of pyrow
#Have the rowing machine on and plugged into the computer before starting the program
#The program will record Time, Distance, SPM, Pace, and Force Data for each stroke and save it to 'workout.csv'
#NOTE: This code has not been thoroughly tested and may not function as advertised.
#Please report and findings to the author so that they may be addressed in a stable release.
import pyrow
import time
#Connecting to erg
ergs = pyrow.find()
if len(ergs) == 0: exit("No ergs found.")
erg = pyrow.pyrow(ergs[0])
print "Connected to erg."
#Open and prepare file
file = open('workout.csv', 'w')
file.write('Time, Distance, SPM, Pace, Force Plot\n')
#Loop until workout has begun
workout = erg.getWorkout()
print "Waiting for workout to start ..."
while workout['state'] == 0:
time.sleep(1)
workout = erg.getWorkout()
print "Workout has begun"
#Loop until workout ends
def main():
#INITIAL SETUP
pygame.init()
pygame.mouse.set_visible(False)
displayFont=pygame.font.Font("fonts/digital-7.ttf",180)
display_smFont=pygame.font.Font("fonts/digital-7.ttf",90)
titleFont=pygame.font.Font("fonts/256BYTES.TTF",180)
smallFont=pygame.font.Font("fonts/256BYTES.TTF",70)
tinyFont=pygame.font.Font("fonts/256BYTES.TTF",30)
screen = pygame.display.set_mode((WINDOWWIDTH,WINDOWHEIGHT))
pygame.display.set_caption(GAMETITLE)
ergs = list(pyrow.find())
if len(ergs) == 0:
exit("No ergs found.")
erg = pyrow.pyrow(ergs[0])
print "Connected to erg."
#SETUP PM VARS
command = ['CSAFE_PM_GET_WORKDISTANCE']
cmeters = 0
pace = 0
wtime = 0
srate = 0
hrate = 0
wtime_mins = 0
wtime_secs = 0
wtime_tenths = 0
pace_mins = 0
pace_secs = 0
calhr = 0
calories = 0
#SPLASH SCREEN
screen.blit(splash,(0,0))
connectedText=tinyFont.render('* Monitor Connected',True,GREEN)
disconnectedText=tinyFont.render('* Monitor Connection Lost - Re-Start!',True,RED)
quitText=tinyFont.render('Press Esc to Exit',True, BLACK)
errexitText=smallFont.render('Press Esc to',True, RED)#after error
errexitText2=smallFont.render('Exit!',True, RED)#after error
startText=smallFont.render('Press Enter',True,BLACK)
startText2=smallFont.render('or Row',True,BLACK)
startText3=smallFont.render('to start',True,BLACK)
pygame.display.update()
pygame.time.wait(1500)
screen.blit(connectedText,(1,1))
screen.blit(quitText,(20,30))
screen.blit(startText,(610,450))
screen.blit(startText2,(685,510))
screen.blit(startText3,(660,560))
pygame.display.update()
#SETUP GAME AND SCREEN DISPLAY VARS
game_over=False
start_game=False
view=0
sample=0
counter=0
plot_col_picker=0
#SETUP SCREEN DISPLAY LABELS
split_units="/500m"
distance_units="m"
srate_units="s/m"
cal_hr_units="cal/hr"
cals_units="cal"
#SETUP VAR LABEL FONTS
split_unitsText=smallFont.render(split_units,True,GOLD)
distance_unitsText=smallFont.render(distance_units,True,PURPLE)
srate_unitsText=smallFont.render(srate_units,True,ORANGE)
cal_hr_unitsText=smallFont.render(cal_hr_units,True,GOLD)
cals_unitsText=smallFont.render(cals_units,True,PURPLE)
#SETUP STATIC MENU TEXT FOR ALL VIEWS
menuText=tinyFont.render("Press 0 = Pace View",True,WHITE)
menuText2=tinyFont.render("Press 1 = Calorie view",True,WHITE)
menuText3=tinyFont.render("Press 2 = Force Curve",True,WHITE)
while start_game==False:
try:
monitor = erg.get_monitor()
if monitor['time'] > 0:#if rowing detected start main loop
start_game=True
except:#display error msg
screen.fill(LTGREY,(1,1,300,60))#x,y,w,h
screen.fill(LTGREY,(600,445,350,200))#x,y,w,h
screen.blit(disconnectedText,(1,1))
screen.blit(errexitText,(610,450))
screen.blit(errexitText2,(720,510))
pygame.display.update()
for event in pygame.event.get():
if event.type==pygame.KEYDOWN:
if event.key==pygame.K_ESCAPE:
game_over=True
pygame.quit()
sys.exit()
elif event.key==pygame.K_RETURN:
start_game=True
#MAIN WORKOUT LOOP
while game_over==False:
for event in pygame.event.get():
if event.type==pygame.KEYDOWN:
if event.key==pygame.K_ESCAPE:
game_over=True
elif event.key==pygame.K_2 or event.key==pygame.K_KP2:
view=2
elif event.key==pygame.K_1 or event.key==pygame.K_KP1:
view=1
elif event.key==pygame.K_0 or event.key==pygame.K_KP0:
view=0
if event.type == pygame.QUIT:#pygame window quit
game_over=True
pygame.quit()
sys.exit()
monitor = erg.get_monitor()
#screen = erg.get_screen()
result = erg.send(command)
#output to terminal
if view==0 or view==1:
print "-------------"
cmeters = result['CSAFE_PM_GET_WORKDISTANCE'][0]/10
print "Meters = " + str(cmeters)
calhr = monitor['calhr']#pre processed data
calhr = str(int(math.ceil(calhr)))
print str(calhr) + " cal/hr"
calories = monitor['calories']
print str(calories) + " calories"
pace = monitor['pace']
pace_mins, pace_secs = divmod(pace, 60) #python math function to get mins and secs
print "%02d:%02d (/500m)" % (pace_mins, pace_secs)
wtime = monitor['time']
print str(wtime) + " time(secs)"
wtime_mins, wtime_secs = divmod(wtime, 60)
wtime_tenths = str(wtime).rsplit('.',1)[1]#split time string to get tenths array pos[1]
if len(wtime_tenths) ==1:#add following zero to exact tenths eg. .60, .70
wtime_tenths = wtime_tenths + "0"
print wtime_tenths + " tenths"
print "%02d:%02d" % (wtime_mins, wtime_secs) + " M:S"
srate = monitor['spm']
print str(srate) + " spm"
hrate = monitor['heartrate']
print str(hrate) + " bpm"
print "Serial = " + str(monitor['serial'])
#print "Display = " + str(monitor['display'])
if view==2:
print counter
power = monitor['power']
#force plot loop
forceplot = erg.get_force_plot()
#Loop while waiting for drive
while forceplot['strokestate'] != 2:
forceplot = erg.get_force_plot()
#Record force data during the drive
force = forceplot['forceplot'] #start of pull (when strokestate first changed to 2)
monitor = erg.get_monitor() #get monitor data for start of stroke
#Loop during drive
while forceplot['strokestate'] == 2:
forceplot = erg.get_force_plot()
force.extend(forceplot['forceplot'])
else: #Get force data from end of stroke
forceplot = erg.get_force_plot()
force.extend(forceplot['forceplot'])
forcedata = ",".join([str(f) for f in force])
print forcedata
print sample
print str(power) + "W"
#output to pygame screen
if view==0:
counter = 0#reset the counter from previous force curve view
screen.blit(background,(0,0))
#DISPLAY STATIC MENU
pygame.draw.rect(screen, BLACK,(30,8,278,95),2)
screen.blit(menuText,(35,10))
screen.blit(menuText2,(35,40))
screen.blit(menuText3,(35,70))
##
#SETUP RETURNED DATA VAR FONTS
timeText=displayFont.render("%02d:%02d " % (wtime_mins, wtime_secs),True,BLUE)
tenthsText=display_smFont.render("." + wtime_tenths,True,BLUE)
paceText=displayFont.render("%02d:%02d " % (pace_mins, pace_secs),True,GOLD)
metersText=displayFont.render(str(cmeters),True,PURPLE)
srateText=displayFont.render(str(srate),True,ORANGE)
hrateText=displayFont.render(str(hrate),True,RED)
screen.blit(timeText,(400,10))
if wtime_mins < 100:
screen.blit(tenthsText,(780,75))
else:#shift tenths figure to right for 3-digit mins
screen.blit(tenthsText,(865,75))
screen.blit(paceText,(400,195))
screen.blit(split_unitsText,(820,260))#label
screen.blit(metersText,(400,395))
screen.blit(distance_unitsText,(825,462))#label
screen.blit(srateText,(110,590))
screen.blit(srate_unitsText,(340,655))#label
screen.blit(hrateText,(670,590))
screen.blit(heart,(900,630))#symbol
pygame.display.update()
if view==1:
counter = 0#reset the counter from previous force curve view
screen.blit(background,(0,0))
#DISPLAY STATIC MENU
pygame.draw.rect(screen, BLACK,(30,8,278,95),2)
screen.blit(menuText,(35,10))
screen.blit(menuText2,(35,40))
screen.blit(menuText3,(35,70))
##
#SETUP RETURNED DATA VAR FONTS
timeText=displayFont.render("%02d:%02d " % (wtime_mins, wtime_secs),True,BLUE)
tenthsText=display_smFont.render("." + wtime_tenths,True,BLUE)
calhrText=displayFont.render(str(calhr),True,GOLD)
caloriesText=displayFont.render(str(calories),True,PURPLE)
srateText=displayFont.render(str(srate),True,ORANGE)
hrateText=displayFont.render(str(hrate),True,RED)
screen.blit(timeText,(400,10))
if wtime_mins < 100:
screen.blit(tenthsText,(780,75))
else:#shift tenths figure to right for 3-digit mins
screen.blit(tenthsText,(865,75))
screen.blit(calhrText,(400,195))
screen.blit(cal_hr_unitsText,(820,260))#label
screen.blit(caloriesText,(400,395))
screen.blit(cals_unitsText,(820,465))#label
screen.blit(srateText,(110,590))
screen.blit(srate_unitsText,(340,655))#label
screen.blit(hrateText,(670,590))
screen.blit(heart,(900,630))#symbol
pygame.display.update()
if view==2:
plot_col_picker = counter
if counter==0: #5 visible force curves before clearing screen
screen.fill(GREY)
screen.blit(graph,(0,0))
elif counter==4:
counter=-1
#DISPLAY STATIC MENU
pygame.draw.rect(screen, BLACK,(30,8,278,95),2)
screen.blit(menuText,(35,10))
screen.blit(menuText2,(35,40))
screen.blit(menuText3,(35,70))
##
counter+=1
sample=20 #starts at 20 pixels along x_axis for first reading
for f in force:
if plot_col_picker == 0: #red
screen.blit(plotter_red,(sample,735-(f*2.52)))
elif plot_col_picker == 1: #green
screen.blit(plotter_green,(sample,735-(f*2.52)))
elif plot_col_picker == 2: #blue
screen.blit(plotter_blue,(sample,735-(f*2.52)))
elif plot_col_picker == 3: #yellow
screen.blit(plotter_yellow,(sample,735-(f*2.52)))
elif plot_col_picker == 4: #black
screen.blit(plotter_black,(sample,735-(f*2.52)))
#screen.blit(plotter,(sample,735-(f*2.52)))
'''y_axis max height (758) / max force (300) = 2.52 (each force unit is 2.52 pixels on y axis)
minus from 735 (y_axis height) to plot the curve starting at bottom since coord 0,0 is top left'''
sample+=13 #moves the plotter 13 pixels along x_axis per cycle
pygame.display.update() #update screen for each plotted point
if plot_col_picker == 0: #red
powerText=smallFont.render(str(power)+"w",True,RED)
screen.blit(powerText,(700,60))
elif plot_col_picker == 1: #green
powerText=smallFont.render(str(power)+"w",True,GREEN)
screen.blit(powerText,(700,130))
elif plot_col_picker == 2: #blue
powerText=smallFont.render(str(power)+"w",True,BLUE)
screen.blit(powerText,(700,200))
elif plot_col_picker == 3: #yellow
powerText=smallFont.render(str(power)+"w",True,GOLD)
screen.blit(powerText,(700,270))
elif plot_col_picker == 4: #black
powerText=smallFont.render(str(power)+"w",True,BLACK)
screen.blit(powerText,(700,340))
pygame.display.update()
#pygame.display.update() either update all views here or update after each view
#handle end of workout
while game_over==True:
pygame.draw.rect(screen, BLACK, (390,300,265,100),0)
endText=tinyFont.render("Session Ended!",True,WHITE)
endText2=tinyFont.render("Press ENTER to EXIT",True,WHITE)
screen.blit(endText,(430,305))
screen.blit(endText2,(400,360))
pygame.display.update()
for event in pygame.event.get():
if event.type==pygame.KEYDOWN:
if event.key==pygame.K_RETURN or event.key==pygame.K_KP_ENTER:
pygame.quit()
sys.exit()
def __init__(self, parent = None):
super(RaspiRowMain, self).__init__(parent)
ergs = pyrow.find()
if len(ergs) == 0: exit("No ergs found.")
self.erg = pyrow.pyrow(ergs[0])
self.initUI()
def USBErgService():
print("USBErgService")
running = True
num_zeros = [0, 0, 0, 0]
num_ones = [0, 0, 0, 0]
prev_time = [0, 0, 0, 0]
ergs = searchErgs()
n_ergs = len(ergs)
# 0 recovery
# 1 drive
state = 0
for i in range(len(ergs)):
m[i] = pyrow.pyrow(ergs[i])
# m[i].dispose_resources()
# return
while (running):
print("running")
# ergs = pyrow.find()
# ergs = list(ergs)
#######
#######
if n_ergs != len(ergs):
# new erg connection
running = False
return
# for i in range(n_ergs,len(ergs)):
# running = False
# break
# print i
# time.sleep(1)
# ergs = pyrow.find()
# ergs = list(ergs)
# m[i] = pyrow.pyrow(ergs[i])
# n_ergs= len(ergs)
try:
for i in range(n_ergs):
# m = pyrow.pyrow(ergs[i])
# print m.get_status()
print "ergData " + str(i)
ergInfo = m[i].get_erg()
data = m[i].get_monitor(forceplot=True)
# continue
data['cid'] = ergInfo['cid']
data['i'] = i
data['avgPower'] = data['power']
# print data
l = len(data['forceplot'])
# continue
# print l
# drive
if (state):
if (l < 1):
state = 0 # recovery
else: # recovery
if (l > 0):
print "change to drive"
strokeData = {
'i': i,
'time': data['time'],
'distance': data['distance'],
'driveLength': 3,
'driveTime': 4,
'strokeRecoveryTime': data['time'] - prev_time[i],
'strokeRecoveryDistance': 6,
'peakDriveForce': 7,
'avgDriveForce': 8,
'workPerStroke': 8,
'strokeCount': 10,
'strokePower': data['power'],
'strokeCalories': 12,
'projectedWorkTime': 13,
'projectedWorkDistance': 14
}
# # print (strokeData);
print("Stroke Data " + str(i))
# print "StrokeDataStart "+str(strokeData);
socketIO.emit('strokeData', strokeData)
state = 1 # drive
socketIO.emit('ergData', data)
continue
# print state
# if(0==len(data['forceplot'])):
# num_zeros[i] +=1
# if(num_ones[i]>3):
# print "StrokeDataEnd "+str(prev_time[i])+" " +str(data['time'])
# data['driveTime']=data['time']-prev_time[i]
# prev_time[i] = data['time']
# # socketIO.emit('strokeData',data)
# num_ones[i]=0
# else:
# num_ones[i] +=1
# #print num_zeros
# if(num_zeros[i]>3):
# # print "rowe started "+str(prev_time[i])+" " +str(data['time'])
# data['strokeRecoveryTime']=data['time']-prev_time[i]
# prev_time[i] = data['time']
# strokeData = {'i':1,'time':data['time'], 'distance':data['distance'], 'driveLength':3, 'driveTime':4, 'strokeRecoveryTime':data['time']-prev_time[i], 'strokeRecoveryDistance':6, 'peakDriveForce':7, 'avgDriveForce':8, 'workPerStroke':8, 'strokeCount':10, 'strokePower':data['power'], 'strokeCalories':12, 'projectedWorkTime':13, 'projectedWorkDistance':14}
# # print (strokeData);
# print "StrokeDataStart "+str(data['time']);
# socketIO.emit('strokeData',strokeData)
# num_zeros[i] = 0
# print "ergData "+str(i)
# socketIO.emit('ergData',data)
# time.sleep(0.005)
# time.sleep(0.10)
# ergs = pyrow.find()
# print len(list(ergys))
# ergs = list(ergs)
# number_ergs = len(ergs)
# time.sleep(0.09)
# ergs = searchErgs()
except Exception as e:
running = False
n_ergs = 0
# time.sleep(1)
print e
print "Search for ergs again"
for i in range(len(ergs)):
m[i] = pyrow.pyrow(ergs[i])
m[i].dispose_resources()
USBErgService()
continue
def USBErgService ( ):
print("USBErgService")
running = True;
num_zeros = [0,0,0,0]
num_ones = [0,0,0,0]
prev_time = [0,0,0,0]
ergs = searchErgs()
n_ergs = len(ergs)
# 0 recovery
# 1 drive
state = 0
for i in range(len(ergs)):
m[i] = pyrow.pyrow(ergs[i])
# m[i].dispose_resources()
# return
while(running):
print("running")
# ergs = pyrow.find()
# ergs = list(ergs)
#######
#######
if n_ergs != len(ergs):
# new erg connection
running = False
return
# for i in range(n_ergs,len(ergs)):
# running = False
# break
# print i
# time.sleep(1)
# ergs = pyrow.find()
# ergs = list(ergs)
# m[i] = pyrow.pyrow(ergs[i])
# n_ergs= len(ergs)
try:
for i in range(n_ergs):
# m = pyrow.pyrow(ergs[i])
# print m.get_status()
print "ergData "+str(i)
ergInfo = m[i].get_erg()
data = m[i].get_monitor(forceplot=True)
# continue
data['cid'] = ergInfo['cid']
data['i'] = i
data['avgPower'] = data['power']
# print data
l = len(data['forceplot'])
# continue
# print l
# drive
if(state):
if(l<1):
state = 0 # recovery
else: # recovery
if(l>0):
print "change to drive"
strokeData = {'i':i,'time':data['time'], 'distance':data['distance'], 'driveLength':3, 'driveTime':4, 'strokeRecoveryTime':data['time']-prev_time[i], 'strokeRecoveryDistance':6, 'peakDriveForce':7, 'avgDriveForce':8, 'workPerStroke':8, 'strokeCount':10, 'strokePower':data['power'], 'strokeCalories':12, 'projectedWorkTime':13, 'projectedWorkDistance':14}
# # print (strokeData);
print ("Stroke Data "+str(i))
# print "StrokeDataStart "+str(strokeData);
socketIO.emit('strokeData',strokeData)
state = 1 # drive
socketIO.emit('ergData',data)
continue
# print state
# if(0==len(data['forceplot'])):
# num_zeros[i] +=1
# if(num_ones[i]>3):
# print "StrokeDataEnd "+str(prev_time[i])+" " +str(data['time'])
# data['driveTime']=data['time']-prev_time[i]
# prev_time[i] = data['time']
# # socketIO.emit('strokeData',data)
# num_ones[i]=0
# else:
# num_ones[i] +=1
# #print num_zeros
# if(num_zeros[i]>3):
# # print "rowe started "+str(prev_time[i])+" " +str(data['time'])
# data['strokeRecoveryTime']=data['time']-prev_time[i]
# prev_time[i] = data['time']
# strokeData = {'i':1,'time':data['time'], 'distance':data['distance'], 'driveLength':3, 'driveTime':4, 'strokeRecoveryTime':data['time']-prev_time[i], 'strokeRecoveryDistance':6, 'peakDriveForce':7, 'avgDriveForce':8, 'workPerStroke':8, 'strokeCount':10, 'strokePower':data['power'], 'strokeCalories':12, 'projectedWorkTime':13, 'projectedWorkDistance':14}
# # print (strokeData);
# print "StrokeDataStart "+str(data['time']);
# socketIO.emit('strokeData',strokeData)
# num_zeros[i] = 0
# print "ergData "+str(i)
# socketIO.emit('ergData',data)
# time.sleep(0.005)
# time.sleep(0.10)
# ergs = pyrow.find()
# print len(list(ergys))
# ergs = list(ergs)
# number_ergs = len(ergs)
# time.sleep(0.09)
# ergs = searchErgs()
except Exception as e:
running=False;
n_ergs = 0
# time.sleep(1)
print e
print "Search for ergs again"
for i in range(len(ergs)):
m[i] = pyrow.pyrow(ergs[i])
m[i].dispose_resources()
USBErgService()
continue
