Added semi-working simulator for estimating robot travel distances

lib/simulator/field.rb

@@ -0,0 +1,31 @@
+module TAC
+  class Simulator
+    class Field
+      def initialize(container:, season:, robot:)
+        @container = container
+        @season = season
+        @robot = robot
+
+        @position = CyberarmEngine::Vector.new
+        @scale = CyberarmEngine::Vector.new(1, 1)
+        @size = 0
+      end
+
+      def draw
+        Gosu.clip_to(@position.x, @position.y, @size, @size) do
+          Gosu.draw_rect(@position.x, @position.y, @size, @size, Gosu::Color::GRAY)
+          # Gosu.scale(@scale.x, @scale.y) do
+            Gosu.translate(@position.x, @position.y) do
+              @robot.draw
+            end
+          # end
+        end
+      end
+
+      def update
+        @position.x, @position.y = @container.x, @container.y
+        @size = @container.width
+      end
+    end
+  end
+end

lib/simulator/robot.rb

@@ -0,0 +1,23 @@
+module TAC
+  class Simulator
+    class Robot
+      attr_accessor :position, :angle
+      def initialize(width:, depth:)
+        @width, @depth = width, depth
+
+        @position = CyberarmEngine::Vector.new
+        @angle = 0
+      end
+
+      def draw
+        Gosu.rotate(@angle, @position.x, @position.y) do
+          Gosu.draw_rect(@position.x - @width / 2, @position.y - @depth / 2, @width, @depth, Gosu::Color::GREEN)
+        end
+      end
+
+      def update
+        @angle %= 360.0
+      end
+    end
+  end
+end

lib/simulator/simulation.rb

@@ -0,0 +1,150 @@
+module TAC
+  class Simulator
+    class Simulation
+      attr_reader :robot
+      def initialize(source_code:, field_container:)
+        @source_code = source_code
+        @field_container = field_container
+
+        @robot = Simulator::Robot.new(width: 18, depth: 18)
+        @field = Field.new(robot: @robot, season: :skystone, container: @field_container)
+        @queue = []
+
+        @unit = :ticks
+        @ticks_per_revolution = 240
+        @gear_ratio = 1
+
+        @last_milliseconds = Gosu.milliseconds
+      end
+
+      def __start
+        self.instance_eval(@source_code)
+      end
+
+      def __draw
+        @field.draw
+      end
+
+      def __update
+        @field.update
+        @robot.update
+
+        if state = @queue.first
+          state.update((Gosu.milliseconds - @last_milliseconds) / 1000.0)
+
+          @queue.delete(state) if state.complete?
+        end
+
+        @last_milliseconds = Gosu.milliseconds
+      end
+
+      def create_robot(width:, height:)
+        @robot = Simulator::Robot.new(width: width, height: height)
+      end
+
+      def set_unit(unit, units_per_revolution = unit)
+        case unit
+        when :ticks, :inches, :centimeters
+          @unit = unit
+        else
+          raise "Unsupported unit '#{unit.inspect}' exected :ticks, :inches or :centimeters"
+        end
+
+        @units_per_revolution = units_per_revolution
+      end
+
+      def set_gear_ratio(from, to)
+        @gear_ratio = Float(from) / Float(to)
+      end
+
+      def set_ticks_per_revolution(ticks)
+        @ticks_per_revolution = Integer(ticks)
+      end
+
+      def forward(distance, power)
+        @queue << Move.new(simulation: self, distance: distance, power: power)
+      end
+
+      def backward(distance, power)
+        @queue << Move.new(simulation: self, distance: -distance, power: power)
+      end
+
+      def turn(relative_angle, power)
+        @queue << Turn.new(simulation: self, relative_angle: relative_angle, power: power)
+      end
+
+      def __speed
+        @ticks_per_revolution * @gear_ratio
+      end
+
+      class State
+        def update(dt)
+        end
+
+        def complete?
+          @complete
+        end
+      end
+
+      class Move < State
+        def initialize(simulation:, distance:, power:)
+          @simulation = simulation
+          @robot = @simulation.robot
+          @distance = distance
+          @power = power
+
+          @starting_position = @robot.position.clone
+          @goal = @starting_position.clone
+          @goal.x += @distance * Math.cos(@robot.angle.gosu_to_radians)
+          @goal.y += @distance * Math.sin(@robot.angle.gosu_to_radians)
+
+          @complete = false
+          @allowable_error = 3.0
+        end
+
+        def update(dt)
+          target = @starting_position + @goal
+          speed = (@distance > 0 ? @power * dt : -@power * dt) * @simulation.__speed
+
+          # TODO: Fix not stopping if travelling at an angle
+          if @robot.position.distance(target) <= @allowable_error
+            @complete = true
+          else
+            @robot.position.x += Math.cos(@robot.angle.gosu_to_radians) * speed
+            @robot.position.y += Math.sin(@robot.angle.gosu_to_radians) * speed
+          end
+        end
+      end
+
+      class Turn < State
+        def initialize(simulation:, relative_angle:, power:)
+          @simulation = simulation
+          @robot = @simulation.robot
+          @relative_angle = relative_angle
+          @power = power
+
+          @starting_angle = @robot.angle
+          @last_angle = @starting_angle
+          @complete = false
+          @allowable_error = 3.0
+        end
+
+        def update(dt)
+          target_angle = (@starting_angle + @relative_angle) % 360.0
+
+          if @robot.angle.between?(target_angle - @allowable_error, target_angle + @allowable_error)
+            @complete = true
+          elsif (@robot.angle - @last_angle).between?(target_angle - @allowable_error, target_angle + @allowable_error)
+            @complete = true
+          elsif target_angle > @starting_angle
+            @robot.angle += @power * dt * @simulation.__speed
+          elsif target_angle < @starting_angle
+            @robot.angle -= @power * dt * @simulation.__speed
+          end
+
+          @last_angle = @robot.angle
+        end
+      end
+    end
+  end
+end

lib/states/editor.rb

@@ -54,7 +54,9 @@ module TAC
                       window.backend.config.configuration.hostname = value
                       window.backend.config_changed!
                     end
+
                     label ":", text_size: 18, margin: 0, padding: 0, padding_top: 3
+
                     @tacnet_port = edit_line "#{window.backend.config.configuration.port}", text_size: 18, width: 0.2, margin_left: 0
                     @tacnet_port.subscribe(:changed) do |caller, value|
                       window.backend.config.configuration.port = Integer(value)

lib/states/simulator.rb

@@ -12,10 +12,46 @@ module TAC
           end
         end
 
-        flow width: 1.0, height: 1.0 do
-          background [Gosu::Color::GRAY, Gosu::Color::BLACK]
+        flow width: 1.0, height: 0.9 do
+          background Gosu::Color::GRAY
+
+          @field_container = stack width: 0.4, height: 1.0 do
+            background Gosu::Color::WHITE
+          end
+
+          stack width: 0.6, height: 1.0 do
+            background Gosu::Color::GREEN
+
+            stack width: 1.0, height: 0.95 do
+              # background Gosu::Color::YELLOW
+              @source_code = edit_line "", width: 1.0, height: 1.0, text_size: 18
+            end
+
+            flow width: 1.0, height: 0.05 do
+              background Gosu::Color::BLUE
+
+              button "Run", text_size: 18, width: 0.49 do
+                @simulation = TAC::Simulator::Simulation.new(source_code: @source_code.value, field_container: @field_container)
+                @simulation.__start
+              end
+              button "Save", text_size: 18, width: 0.49
+            end
+          end
         end
       end
+
+      def draw
+        super
+
+        Gosu.flush
+        @simulation.__draw if @simulation
+      end
+
+      def update
+        super
+
+        @simulation.__update if @simulation
+      end
     end
   end
 end

timecrafters_configuration_tool.rb

@@ -13,6 +13,9 @@ require_relative "lib/states/boot"
 require_relative "lib/states/editor"
 require_relative "lib/states/simulator"
 require_relative "lib/states/manage_presets"
+require_relative "lib/simulator/robot"
+require_relative "lib/simulator/field"
+require_relative "lib/simulator/simulation"
 require_relative "lib/theme"
 require_relative "lib/logger"
 require_relative "lib/dialog"