Sub MoveCraneArm(direction As UInt)
ServoArm.Attach(ServoArmPin.PinNumber)
ServoArmAnglePos = ServoArm.Read
LEDRedPinOn = True
LEDRedPin.DigitalWrite(LEDRedPinOn)
LEDGreenPinOn = False
LEDGreenPin.DigitalWrite(LEDGreenPinOn)
If direction = 1 Then
If ServoArmAnglePos <= (ServoArmAngleMax - ServoArmAngleMove) Then
ServoArmAnglePos = ServoArmAnglePos + ServoArmAngleMove
Else
ServoArmAnglePos = ServoArmAngleMax
End If
End If
If direction = 2 Then
If ServoArmAnglePos >= (ServoArmAngleMin + ServoArmAngleMove) Then
ServoArmAnglePos = ServoArmAnglePos - ServoArmAngleMove
Else
ServoArmAnglePos = ServoArmAngleMin
End If
End If
ServoArm.Write(ServoArmAnglePos)
Delay(250)
LEDRedPinOn = False
LEDRedPin.DigitalWrite(LEDRedPinOn)
LEDGreenPinOn = True
LEDGreenPin.DigitalWrite(LEDGreenPinOn)
ServoArm.Detach
'Send message in JSON format to the B4J server
AStream.Write("{""Angle"":")
AStream.Write(NumberFormat(ServoArmAnglePos,0,0))
AStream.Write("}")
End Sub