mirror of
https://github.com/brmlab/NeuroskyTest.git
synced 2025-06-07 18:04:05 +02:00
Initial commit - software by tomsuch
This commit is contained in:
Petr Baudis
commit
85332d79d1
4 changed files with 423 additions and 0 deletions
16
.project
Normal file
16
.project
Normal file
|
|
@ -0,0 +1,16 @@
|
||||||
|
# Gambas Project File 2.0
|
||||||
|
# Compiled with Gambas 2.23.1
|
||||||
|
Title=NeuroskyTest
|
||||||
|
Startup=FMain
|
||||||
|
Version=0.0.3
|
||||||
|
Library=gb.gui
|
||||||
|
Library=gb.form
|
||||||
|
Library=gb.image
|
||||||
|
Library=gb.net
|
||||||
|
Library=gb.net.smtp
|
||||||
|
Library=gb.opengl
|
||||||
|
Library=gb.vb
|
||||||
|
TabSize=2
|
||||||
|
ControlPublic=1
|
||||||
|
ModulePublic=1
|
||||||
|
ExecPath=NeuroskyTest.gambas
|
||||||
22
.settings
Normal file
22
.settings
Normal file
|
|
@ -0,0 +1,22 @@
|
||||||
|
[Breakpoints]
|
||||||
|
Count=0
|
||||||
|
|
||||||
|
[DebugWindow]
|
||||||
|
Count=0
|
||||||
|
|
||||||
|
[FFind]
|
||||||
|
SearchIn="Module"
|
||||||
|
CaseSensitive=False
|
||||||
|
SearchWord=False
|
||||||
|
SearchComment=False
|
||||||
|
SearchString=True
|
||||||
|
|
||||||
|
[OpenFile]
|
||||||
|
File[1]="FMain.form"
|
||||||
|
File[2]="FMain.class:189.17"
|
||||||
|
Active=2
|
||||||
|
Count=2
|
||||||
|
|
||||||
|
[Watches]
|
||||||
|
Count=0
|
||||||
|
|
||||||
296
FMain.class
Normal file
296
FMain.class
Normal file
|
|
@ -0,0 +1,296 @@
|
||||||
|
' Gambas class file
|
||||||
|
|
||||||
|
PUBLIC CONST state_start AS Integer = 1
|
||||||
|
PUBLIC CONST state_sync AS Integer = 2
|
||||||
|
PUBLIC CONST state_size AS Integer = 3
|
||||||
|
PUBLIC CONST state_payload AS Integer = 4
|
||||||
|
PUBLIC CONST state_checksum AS Integer = 5
|
||||||
|
|
||||||
|
'PUBLIC FormResetLock AS Boolean = FALSE
|
||||||
|
|
||||||
|
PUBLIC plotx AS Integer = 0
|
||||||
|
PUBLIC plt_last AS Integer = 0
|
||||||
|
|
||||||
|
PUBLIC CONST data_code AS Integer = 1
|
||||||
|
PUBLIC CONST data_length AS Integer = 2
|
||||||
|
PUBLIC CONST data_value AS Integer = 3
|
||||||
|
|
||||||
|
PUBLIC ParseState AS Integer = state_start
|
||||||
|
|
||||||
|
PUBLIC PacketSize AS Byte
|
||||||
|
PUBLIC packetCounter AS Integer
|
||||||
|
PUBLIC PacketChecksum AS Byte
|
||||||
|
|
||||||
|
PUBLIC PacketIdx AS Integer
|
||||||
|
|
||||||
|
PUBLIC PacketBuffer AS NEW Byte[256]
|
||||||
|
'PUBLIC PacketTmp AS NEW Byte[256]
|
||||||
|
|
||||||
|
PUBLIC lamp_red AS Integer
|
||||||
|
PUBLIC lamp_blue AS Integer
|
||||||
|
PUBLIC lamp_green AS Integer
|
||||||
|
|
||||||
|
PUBLIC SUB _new()
|
||||||
|
|
||||||
|
END
|
||||||
|
|
||||||
|
PUBLIC SUB Form_Open()
|
||||||
|
ComboBox1.add("RG")
|
||||||
|
ComboBox1.Add("CB")
|
||||||
|
ComboBox1.Index = 1
|
||||||
|
END
|
||||||
|
|
||||||
|
PUBLIC SUB ErrHandler(vstup AS String)
|
||||||
|
Message.error(vstup & "\n" & Error.text)
|
||||||
|
END
|
||||||
|
|
||||||
|
PUBLIC SUB btn_connect_Click()
|
||||||
|
|
||||||
|
IF SerialPort.Status = 0 THEN
|
||||||
|
SerialPort.PortName = "/dev/rfcomm0"
|
||||||
|
SerialPort.Speed = 57600
|
||||||
|
SerialPort.DataBits = 8
|
||||||
|
SerialPort.StopBits = 1
|
||||||
|
SerialPort.FlowControl = FALSE
|
||||||
|
SerialPort.Open
|
||||||
|
ELSE
|
||||||
|
SerialPort.Close
|
||||||
|
ENDIF
|
||||||
|
CATCH
|
||||||
|
ErrHandler("NeuroSky SerialPort - Error")
|
||||||
|
END
|
||||||
|
PUBLIC SUB SerialPort_Read()
|
||||||
|
DIM InByte AS Byte
|
||||||
|
'Message("CTU")
|
||||||
|
READ #SerialPort, InByte
|
||||||
|
|
||||||
|
'TextBox1.Text = TextBox1.Text & InByte & ";"
|
||||||
|
|
||||||
|
SELECT CASE ParseState
|
||||||
|
CASE state_start
|
||||||
|
IF InByte = 170 THEN ParseState = state_sync
|
||||||
|
CASE state_sync
|
||||||
|
IF InByte = 170 THEN
|
||||||
|
ParseState = state_size
|
||||||
|
ELSE
|
||||||
|
ParseState = state_start
|
||||||
|
ENDIF
|
||||||
|
CASE state_size
|
||||||
|
PacketSize = InByte
|
||||||
|
'TextBox2.Text = PacketSize
|
||||||
|
ParseState = state_payload
|
||||||
|
packetCounter = 0
|
||||||
|
PacketChecksum = 0
|
||||||
|
CASE state_payload
|
||||||
|
PacketBuffer[packetCounter] = InByte
|
||||||
|
PacketChecksum = PacketChecksum + InByte
|
||||||
|
packetCounter = packetCounter + 1
|
||||||
|
IF packetCounter = PacketSize THEN ParseState = state_checksum
|
||||||
|
CASE state_checksum
|
||||||
|
PacketChecksum = PacketChecksum XOR 255
|
||||||
|
IF InByte = PacketChecksum THEN
|
||||||
|
txt_crc.Text = "OK"
|
||||||
|
ParseState = state_start
|
||||||
|
PacketIdx = PacketIdx + 1
|
||||||
|
txt_packets.Text = PacketIdx
|
||||||
|
'PacketTmp = PacketBuffer
|
||||||
|
'TextBox5.Clear
|
||||||
|
Parsuj(PacketSize)
|
||||||
|
ELSE
|
||||||
|
txt_crc.Text = "CHYBA"
|
||||||
|
ParseState = state_start
|
||||||
|
ENDIF
|
||||||
|
CASE ELSE
|
||||||
|
|
||||||
|
END SELECT
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
'TextBox1.Text = TextBox1.Text & ";" & InByte
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
END
|
||||||
|
|
||||||
|
|
||||||
|
PUBLIC SUB Parsuj(size AS Integer)
|
||||||
|
DIM i, x AS Integer
|
||||||
|
DIM state AS Integer
|
||||||
|
DIM excode AS Integer
|
||||||
|
DIM code AS Integer
|
||||||
|
DIM length AS Integer
|
||||||
|
DIM data AS NEW Byte[128]
|
||||||
|
DIM data_idx AS Integer
|
||||||
|
DIM strtmp AS String
|
||||||
|
DIM PacketTmp AS NEW Byte[256]
|
||||||
|
|
||||||
|
PacketTmp = PacketBuffer
|
||||||
|
|
||||||
|
data_idx = 0
|
||||||
|
code = 0
|
||||||
|
excode = 0
|
||||||
|
state = data_code
|
||||||
|
|
||||||
|
FOR i = 0 TO size - 1
|
||||||
|
'TextBox5.Text = TextBox5.Text & PacketTmp[i] & ";"
|
||||||
|
SELECT CASE state
|
||||||
|
CASE data_code
|
||||||
|
IF PacketTmp[i] = 85 THEN
|
||||||
|
excode = excode + 1
|
||||||
|
ELSE
|
||||||
|
code = PacketTmp[i]
|
||||||
|
IF code > 127 THEN
|
||||||
|
state = data_length
|
||||||
|
ELSE
|
||||||
|
length = 1
|
||||||
|
state = data_value
|
||||||
|
ENDIF
|
||||||
|
ENDIF
|
||||||
|
CASE data_length
|
||||||
|
length = PacketTmp[i]
|
||||||
|
state = data_value
|
||||||
|
CASE data_value
|
||||||
|
data[data_idx] = PacketTmp[i]
|
||||||
|
data_idx = data_idx + 1
|
||||||
|
IF data_idx = length THEN
|
||||||
|
FOR x = 0 TO length - 1
|
||||||
|
strtmp = strtmp & data[x] & "."
|
||||||
|
NEXT
|
||||||
|
Zpracuj(code, data, length)
|
||||||
|
'TextArea1.Text = (Str(PacketIdx) & ":" & Str(code) & ";" & strtmp & ";" & Str(length)) & "\n" & TextArea1.Text
|
||||||
|
strtmp = ""
|
||||||
|
data_idx = 0
|
||||||
|
code = 0
|
||||||
|
excode = 0
|
||||||
|
state = data_code
|
||||||
|
length = 0
|
||||||
|
ENDIF
|
||||||
|
CASE ELSE
|
||||||
|
END SELECT
|
||||||
|
NEXT
|
||||||
|
|
||||||
|
END
|
||||||
|
|
||||||
|
PUBLIC SUB update_lampa()
|
||||||
|
DIM brightness, hue AS Float
|
||||||
|
|
||||||
|
SELECT CASE ComboBox1.Text
|
||||||
|
CASE "RG"
|
||||||
|
lamp_red = Progress_attention.Value * 200
|
||||||
|
lamp_green = Progress_meditation.Value * 200
|
||||||
|
CASE "CB"
|
||||||
|
brightness = 1 - Progress_meditation.Value
|
||||||
|
hue = Progress_attention.Value
|
||||||
|
lamp_red = brightness * 200 * hue
|
||||||
|
lamp_green = brightness * 200 * (1 - hue)
|
||||||
|
END SELECT
|
||||||
|
|
||||||
|
nastav_lampu("r " & lamp_red & " " & lamp_green & " " & "0")
|
||||||
|
|
||||||
|
END
|
||||||
|
|
||||||
|
|
||||||
|
PUBLIC SUB Zpracuj(code AS Byte, data AS Byte[], length AS Integer)
|
||||||
|
DIM raw_eeg AS Integer
|
||||||
|
DIM plt_aktual AS Integer
|
||||||
|
IF code = 2 THEN
|
||||||
|
progress_signal.Value = 1 - (data[0] / 200)
|
||||||
|
ENDIF
|
||||||
|
IF code = 4 THEN
|
||||||
|
Progress_attention.Value = data[0] / 100
|
||||||
|
update_lampa
|
||||||
|
ENDIF
|
||||||
|
IF code = 5 THEN
|
||||||
|
Progress_meditation.Value = data[0] / 100
|
||||||
|
update_lampa
|
||||||
|
ENDIF
|
||||||
|
IF code = 128 THEN
|
||||||
|
raw_eeg = (data[0] * 256) + data[1]
|
||||||
|
IF raw_eeg > 32767 THEN raw_eeg = raw_eeg - 65536
|
||||||
|
|
||||||
|
raw_eeg = raw_eeg * 40
|
||||||
|
|
||||||
|
Draw.Begin(dwgplot)
|
||||||
|
Draw.ForeColor = Color.White
|
||||||
|
|
||||||
|
plt_aktual = (raw_eeg + 32768) / (65536 / dwgplot.Height)
|
||||||
|
IF plotx = 0 THEN
|
||||||
|
Draw.Point(plotx, plt_aktual)
|
||||||
|
plt_last = plt_aktual
|
||||||
|
ELSE
|
||||||
|
Draw.Line(plotx - 1, plt_last, plotx, plt_aktual)
|
||||||
|
plt_last = plt_aktual
|
||||||
|
ENDIF
|
||||||
|
Draw.End
|
||||||
|
plotx = plotx + 1
|
||||||
|
IF plotx > dwgplot.Width THEN
|
||||||
|
plotx = 0
|
||||||
|
dwgplot.Clear
|
||||||
|
ENDIF
|
||||||
|
ENDIF
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
END
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
PUBLIC SUB btn_lam_con_Click()
|
||||||
|
IF SerialLamp.Status = 0 THEN
|
||||||
|
SerialLamp.PortName = "/dev/ttyUSB0"
|
||||||
|
SerialLamp.Speed = 9600
|
||||||
|
SerialLamp.DataBits = 8
|
||||||
|
SerialLamp.StopBits = 1
|
||||||
|
SerialLamp.FlowControl = FALSE
|
||||||
|
SerialLamp.Open
|
||||||
|
ELSE
|
||||||
|
SerialLamp.Close
|
||||||
|
ENDIF
|
||||||
|
CATCH
|
||||||
|
ErrHandler("Lamp SerialPort - Error")
|
||||||
|
END
|
||||||
|
|
||||||
|
PUBLIC SUB nastav_lampu(vstup AS String)
|
||||||
|
IF SerialLamp.status = 1 THEN
|
||||||
|
PRINT #SerialLamp, vstup
|
||||||
|
ENDIF
|
||||||
|
CATCH
|
||||||
|
ErrHandler("Lamp SerialPort - COMMAND Error")
|
||||||
|
END
|
||||||
|
|
||||||
|
|
||||||
|
PUBLIC SUB Timer1_Timer()
|
||||||
|
IF SerialLamp.Status = 0 THEN
|
||||||
|
Label6.BackColor = Color.Red
|
||||||
|
ELSE IF SerialLamp.Status = 1 THEN
|
||||||
|
Label6.BackColor = Color.Green
|
||||||
|
ELSE
|
||||||
|
Label6.BackColor = Color.Orange
|
||||||
|
ENDIF
|
||||||
|
|
||||||
|
IF SerialPort.Status = 0 THEN
|
||||||
|
Label5.BackColor = Color.Red
|
||||||
|
FormReset
|
||||||
|
ELSE IF SerialPort.Status = 1 THEN
|
||||||
|
Label5.BackColor = Color.Green
|
||||||
|
ELSE
|
||||||
|
Label5.BackColor = Color.Orange
|
||||||
|
ENDIF
|
||||||
|
END
|
||||||
|
|
||||||
|
|
||||||
|
PUBLIC SUB FormReset()
|
||||||
|
Progress_attention.Value = 0
|
||||||
|
Progress_meditation.Value = 0
|
||||||
|
progress_signal.Value = 0
|
||||||
|
txt_crc.Text = "- - -"
|
||||||
|
txt_packets.Text = 0
|
||||||
|
dwgplot.Clear
|
||||||
|
WAIT
|
||||||
|
END
|
||||||
|
|
||||||
89
FMain.form
Normal file
89
FMain.form
Normal file
|
|
@ -0,0 +1,89 @@
|
||||||
|
# Gambas Form File 2.0
|
||||||
|
|
||||||
|
{ Form Form
|
||||||
|
Move(0,0,679,287)
|
||||||
|
#(Scaled) = False
|
||||||
|
Text = ("")
|
||||||
|
{ btn_connect Button
|
||||||
|
Move(7,7,98,28)
|
||||||
|
Text = ("NeuroSky")
|
||||||
|
}
|
||||||
|
{ SerialPort #SerialPort
|
||||||
|
#X = 539
|
||||||
|
#Y = 28
|
||||||
|
}
|
||||||
|
{ txt_crc TextBox
|
||||||
|
Move(329,42,105,21)
|
||||||
|
Text = (" - - -")
|
||||||
|
}
|
||||||
|
{ txt_packets TextBox
|
||||||
|
Move(329,14,105,21)
|
||||||
|
Text = ("0")
|
||||||
|
}
|
||||||
|
{ progress_attention ProgressBar
|
||||||
|
Move(126,231,210,21)
|
||||||
|
}
|
||||||
|
{ progress_meditation ProgressBar
|
||||||
|
Move(126,259,210,21)
|
||||||
|
}
|
||||||
|
{ SerialLamp #SerialPort
|
||||||
|
#X = 497
|
||||||
|
#Y = 28
|
||||||
|
}
|
||||||
|
{ btn_lam_con Button
|
||||||
|
Move(112,7,98,28)
|
||||||
|
Text = ("Lampa")
|
||||||
|
}
|
||||||
|
{ DwgPlot DrawingArea
|
||||||
|
Move(7,70,658,154)
|
||||||
|
Background = &H000000&
|
||||||
|
Cached = True
|
||||||
|
}
|
||||||
|
{ ComboBox1 ComboBox
|
||||||
|
Move(511,231,154,21)
|
||||||
|
Text = ("ComboBox1")
|
||||||
|
}
|
||||||
|
{ Label1 Label
|
||||||
|
Move(14,231,105,21)
|
||||||
|
Text = ("SOUSTREDENI")
|
||||||
|
}
|
||||||
|
{ Label2 Label
|
||||||
|
Move(14,259,105,14)
|
||||||
|
Text = ("RELAXACE")
|
||||||
|
}
|
||||||
|
{ Label3 Label
|
||||||
|
Move(224,14,98,21)
|
||||||
|
Text = ("Prijato paketu:")
|
||||||
|
}
|
||||||
|
{ Label4 Label
|
||||||
|
Move(224,42,98,21)
|
||||||
|
Text = ("Kontrola CRC:")
|
||||||
|
}
|
||||||
|
{ Timer1 #Timer
|
||||||
|
#X = 455
|
||||||
|
#Y = 28
|
||||||
|
Enabled = True
|
||||||
|
Delay = 100
|
||||||
|
}
|
||||||
|
{ Label5 Label
|
||||||
|
Move(7,42,98,21)
|
||||||
|
Text = ("STATUS")
|
||||||
|
Alignment = Align.Center
|
||||||
|
}
|
||||||
|
{ Label6 Label
|
||||||
|
Move(112,42,98,21)
|
||||||
|
Text = ("STATUS")
|
||||||
|
Alignment = Align.Center
|
||||||
|
}
|
||||||
|
{ Label7 Label
|
||||||
|
Move(413,231,84,21)
|
||||||
|
Text = ("PROGRAM")
|
||||||
|
}
|
||||||
|
{ progress_signal ProgressBar
|
||||||
|
Move(581,14,77,21)
|
||||||
|
}
|
||||||
|
{ Label8 Label
|
||||||
|
Move(504,14,56,21)
|
||||||
|
Text = ("SIGNAL")
|
||||||
|
}
|
||||||
|
}
|
||||||
Loading…
Add table
Add a link
Reference in a new issue