' Raspberry Pi LPC1114 I/O Processor Expansion Board SPI Agent Firmware
' Pulse Width Modulation output test program

' Copyright (C)2015-2018, Philip Munts, President, Munts AM Corp.
'
' Redistribution and use in source and binary forms, with or without
' modification, are permitted provided that the following conditions are met:
'
' * Redistributions of source code must retain the above copyright notice,
'   this list of conditions and the following disclaimer.
'
' THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
' IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
' ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
' LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
' CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
' SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
' INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
' CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
' ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
' POSSIBILITY OF SUCH DAMAGE.

' Layout the GUI

IsTablet = LDFile.Exists("C:\ProgramData\MuntsTechnologies\tablet.txt")

GraphicsWindow.Title = "Raspberry Pi LPC1114 Servo Output Test"
GraphicsWindow.BrushColor = "black"

If IsTablet Then
  ' Layout the GUI for Windows tablet

  LDUtilities.GWState = 2
  W = GraphicsWindow.Width
  H = GraphicsWindow.Height
  GraphicsWindow.FontSize = 32
  GraphicsWindow.DrawText(W/2 - 300,  50, "Raspberry Pi LPC1114 I/O Processor")
  GraphicsWindow.DrawText(W/2 - 300, 100, "Expansion Board SPI Agent Firmware")
  GraphicsWindow.DrawText(W/2 - 300, 150, "Servo Motor Test")
  GraphicsWindow.FontSize = 30
  GraphicsWindow.DrawText(W/2 - 270, 250, "Server name:")
  TextBoxServerName = Controls.AddTextBox(W/2 - 60, 250)
  ButtonConnect = Controls.AddButton("Connect", W/2 + 120, 250)
  LabelServo1 = Shapes.AddText("Servo1")
  LabelServo2 = Shapes.AddText("Servo2")
  LabelServo3 = Shapes.AddText("Servo3")
  LabelServo4 = Shapes.AddText("Servo4")
  Controls.Move(LabelServo1, W/2 - 280, 350)
  Controls.Move(LabelServo2, W/2 - 130, 350)
  Controls.Move(LabelServo3, W/2 + 20, 350)
  Controls.Move(LabelServo4, W/2 + 170, 350)
  SliderServo1 = LDControls.AddSlider(25, 100, "V")
  SliderServo2 = LDControls.AddSlider(25, 100, "V")
  SliderServo3 = LDControls.AddSlider(25, 100, "V")
  SliderServo4 = LDControls.AddSlider(25, 100, "V")
  Shapes.Zoom(SliderServo1, 2.0, 2.0)
  Shapes.Zoom(SliderServo2, 2.0, 2.0)
  Shapes.Zoom(SliderServo3, 2.0, 2.0)
  Shapes.Zoom(SliderServo4, 2.0, 2.0)
  Controls.Move(SliderServo1, W/2 - 230, 450)
  Controls.Move(SliderServo2, W/2 - 80, 450)
  Controls.Move(SliderServo3, W/2 + 70, 450)
  Controls.Move(SliderServo4, W/2 + 220, 450)
Else
  ' Layout the GUI for Windows Desktop

  GraphicsWindow.Width = 400
  GraphicsWindow.Height = 260
  GraphicsWindow.FontSize = 18
  GraphicsWindow.DrawText(30, 10, "Raspberry Pi LPC1114 I/O Processor")
  GraphicsWindow.DrawText(30, 30, "Expansion Board SPI Agent Firmware")
  GraphicsWindow.DrawText(30, 50, "Servo Motor Test")
  GraphicsWindow.FontSize = 14
  GraphicsWindow.DrawText(30, 84, "Server name:")
  TextBoxServerName = Controls.AddTextBox(130, 80)
  ButtonConnect = Controls.AddButton("Connect", 300, 78)
  LabelServo1 = Shapes.AddText("Servo1")
  LabelServo2 = Shapes.AddText("Servo2")
  LabelServo3 = Shapes.AddText("Servo3")
  LabelServo4 = Shapes.AddText("Servo4")
  Controls.Move(LabelServo1, 20, 120)
  Controls.Move(LabelServo2, 125, 120)
  Controls.Move(LabelServo3, 225, 120)
  Controls.Move(LabelServo4, 325, 120)
  SliderServo1 = LDControls.AddSlider(25, 100, "V")
  SliderServo2 = LDControls.AddSlider(25, 100, "V")
  SliderServo3 = LDControls.AddSlider(25, 100, "V")
  SliderServo4 = LDControls.AddSlider(25, 100, "V")
  Controls.Move(SliderServo1, 40, 140)
  Controls.Move(SliderServo2, 140, 140)
  Controls.Move(SliderServo3, 240, 140)
  Controls.Move(SliderServo4, 340, 140)
  GraphicsWindow.Show()
Endif

Controls.HideControl(LabelServo1)
Controls.HideControl(LabelServo2)
Controls.HideControl(LabelServo3)
Controls.HideControl(LabelServo4)

Controls.HideControl(SliderServo1)
Controls.HideControl(SliderServo2)
Controls.HideControl(SliderServo3)
Controls.HideControl(SliderServo4)

' Preload server name from command line argument

If Program.ArgumentCount = 1 Then
  Controls.SetTextBoxText(TextBoxServerName, Program.GetArgument(1))
Endif

' Register the event handler subroutines

Controls.ButtonClicked = ButtonHandler
LDControls.SliderChanged = SliderHandler

' This subroutine handles button presses

Sub ButtonHandler
  c = Controls.GetButtonCaption(Controls.LastClickedButton)

  If c = "Connect" Then
    SPIAgent.Open(Controls.GetTextBoxText(TextBoxServerName))
    If SPIAgent.error <> 0 Then
      GraphicsWindow.ShowMessage("SPIAgent.Open() returned error " + SPIAgent.error, "ERROR:")
      Goto ButtonHandlerDone
    Endif

    SPIAgent.PWM1_Frequency = 50
    SPIAgent.PWM2_Frequency = 50
    SPIAgent.PWM3_Frequency = 50
    SPIAgent.PWM4_Frequency = 50

    SPIAgent.Servo1 = 0
    SPIAgent.Servo2 = 0
    SPIAgent.Servo3 = 0
    SPIAgent.Servo4 = 0

    LDControls.SliderValue(SliderServo1, 50)
    LDControls.SliderValue(SliderServo2, 50)
    LDControls.SliderValue(SliderServo3, 50)
    LDControls.SliderValue(SliderServo4, 50)

    Controls.ShowControl(LabelServo1)
    Controls.ShowControl(LabelServo2)
    Controls.ShowControl(LabelServo3)
    Controls.ShowControl(LabelServo4)

    Controls.ShowControl(SliderServo1)
    Controls.ShowControl(SliderServo2)
    Controls.ShowControl(SliderServo3)
    Controls.ShowControl(SliderServo4)

    Controls.SetButtonCaption(ButtonConnect, "Disconnect")
  ElseIf c = "Disconnect" Then
    SPIAgent.Close()

    Controls.HideControl(LabelServo1)
    Controls.HideControl(LabelServo2)
    Controls.HideControl(LabelServo3)
    Controls.HideControl(LabelServo4)

    Controls.HideControl(SliderServo1)
    Controls.HideControl(SliderServo2)
    Controls.HideControl(SliderServo3)
    Controls.HideControl(SliderServo4)

    Controls.SetButtonCaption(ButtonConnect, "Connect")
  EndIf

  ButtonHandlerDone:
EndSub

' This subroutine handles slider changes

Sub SliderHandler
  s = LDControls.LastSlider

  If s = SliderServo1 Then
    SPIAgent.Servo1 = (LDControls.SliderGetValue(SliderServo1)-50)/50
  ElseIf s = SliderServo2 Then
    SPIAgent.Servo2 = (LDControls.SliderGetValue(SliderServo2)-50)/50
  ElseIF s = SliderServo3 Then
    SPIAgent.Servo3 = (LDControls.SliderGetValue(SliderServo3)-50)/50
  ElseIF s = SliderServo4 Then
    SPIAgent.Servo4 = (LDControls.SliderGetValue(SliderServo4)-50)/50
  EndIF
EndSub