serial.bas

来自「玩具机器人的PC控制程序,该机器人可做面部表情,该界面可以保持多种表情和对每个部」· BAS 代码 · 共 42 行

Attribute VB_Name = "Module1"
Option Explicit

Public ComOCX As MSComm

Public Sub OpenSerial(ByVal ComPort As Integer, ByVal sSetting As String)
    With ComOCX
        .Settings = sSetting
        .CommPort = ComPort
        .PortOpen = True
    End With
End Sub

Public Sub CloseSerial()
    ComOCX.PortOpen = False
End Sub

 Public Sub SendData(ByVal ServoMotor As Integer, ByVal Speed As Integer, ByVal ServoPosition As Integer)
   
   Dim Data(0 To 2) As Byte
    If (Speed < 0) Or (Speed > 7) Then
        Stop
        Exit Sub
    End If
    
    If (ServoMotor < 1) Or (ServoMotor > 24) Then
        Stop
        Exit Sub
    End If
    
    If (ServoPosition < 0) Or (ServoPosition > 255) Then
        Stop
        Exit Sub
    End If
   
    Data(0) = &HFF
    Data(1) = Speed * 32 + ServoMotor
    Data(2) = ServoPosition
    ComOCX.Output = Data
    
End Sub