Added arrays to queues.

Change-Id: Ifcb5ff0ecdbd47e7fa445275195cd7a87e96c20a
diff --git a/aos/build/queues/cpp_pretty_print/dep_file_pair.rb b/aos/build/queues/cpp_pretty_print/dep_file_pair.rb
index c13bb9e..63b3fbd 100644
--- a/aos/build/queues/cpp_pretty_print/dep_file_pair.rb
+++ b/aos/build/queues/cpp_pretty_print/dep_file_pair.rb
@@ -326,7 +326,7 @@
 				state.pp("template < ")
 				state.pp(@t_args)
 			else
-				state.pp("template <")
+				state.pp("template < ")
 			end
 			state.pp(">\n")
 		end
diff --git a/aos/build/queues/cpp_pretty_print/file_pair_types.rb b/aos/build/queues/cpp_pretty_print/file_pair_types.rb
index 8f60b77..25ce4fe 100644
--- a/aos/build/queues/cpp_pretty_print/file_pair_types.rb
+++ b/aos/build/queues/cpp_pretty_print/file_pair_types.rb
@@ -157,7 +157,7 @@
 			state.pp("template < ")
 			state.pp(@t_args)
 		else
-			state.pp("template <")
+			state.pp("template < ")
 		end
 		state.pp(">\n")
 		state.pp("class #@name")
diff --git a/aos/build/queues/objects/queue.rb b/aos/build/queues/objects/queue.rb
index 610bdf7..81cd181 100644
--- a/aos/build/queues/objects/queue.rb
+++ b/aos/build/queues/objects/queue.rb
@@ -84,16 +84,21 @@
 		check_type_error(locals)
 		if(@is_struct_type)
 			tval = lookup_type(locals)
-			member = Target::MessageStructElement.new(tval, name)
+			member = Target::MessageStructElement.new(tval, @name)
+      if (@length != nil)
+        inner_member = member
+        member = Target::MessageArrayElement.new(inner_member, @length)
+      end
 		else
-			if(@length == nil)
-				member = Target::MessageElement.new(@type,@name)
-			else
-				member = Target::MessageArrayElement.new(@type,@name,@length)
-			end
+			member = Target::MessageElement.new(@type,@name)
 			member.size = size()
 			member.zero = Zero[@type] || "0";
 			member.printformat = toPrintFormat()
+
+			if(@length != nil)
+        inner_member = member
+				member = Target::MessageArrayElement.new(inner_member,@length)
+			end
 		end
 		locals.local.add_member(member)
 	end
diff --git a/aos/build/queues/output/message_dec.rb b/aos/build/queues/output/message_dec.rb
index 903a872..36300ea 100644
--- a/aos/build/queues/output/message_dec.rb
+++ b/aos/build/queues/output/message_dec.rb
@@ -16,7 +16,7 @@
 			if(member.respond_to?(:add_TypeRegister))
         register_members.push(member)
 			end
-			fields << "new ::aos::MessageType::Field{#{tId}, #{fieldName}}"
+			fields << "new ::aos::MessageType::Field{#{tId}, #{member.respond_to?(:length) ? member.length : 0}, #{fieldName}}"
 		end
     register_members.uniq do |member|
       member.type
@@ -35,12 +35,12 @@
           type_class.add_member(cons)
           @members.each do |member|
             if member.respond_to?(:type_name)
-              type_name = member.type_name(cpp_tree)
+              type_name = "#{member.type_name(cpp_tree)} #{member.name}_in"
             else
-              type_name = member.type
+              type_name = member.create_usage(cpp_tree, "#{member.name}_in")
             end
 
-            cons.args << "#{type_name} #{member.name}_in"
+            cons.args << type_name
             cons.add_cons(member.name, member.name + '_in')
           end
         end
@@ -187,7 +187,7 @@
 		type_class.set_parent("public ::aos::Message")
 		ts = self.simpleStr()
 		self.msg_hash = "0x#{Digest::SHA1.hexdigest(ts)[-8..-1]}"
-		type_class.add_member("enum {kQueueLength = 200, kHash = #{self.msg_hash}}")
+		type_class.add_member("enum {kQueueLength = 100, kHash = #{self.msg_hash}}")
 		@members.each do |elem|
 			type_class.add_member(elem.create_usage(cpp_tree))
 		end
@@ -245,22 +245,37 @@
 	def initialize(type,name)
 		@type,@name = type,name
 	end
+  def type()
+    return @type
+  end
+  def type_name(cpp_tree)
+    return type()
+  end
 	def toPrintFormat()
 		return printformat
 	end
-	def create_usage(cpp_tree)
-		"#{@type} #{@name}"
+	def create_usage(cpp_tree, this_name=nil)
+    if (this_name == nil)
+      this_name = @name
+    end
+		"#{@type} #{this_name}"
 	end
-	def toNetwork(offset,suite, parent = "")
+	def toNetwork(offset,suite, parent = "", this_name=nil)
+    if (this_name == nil)
+      this_name = @name
+    end
 		suite << f_call = CPP::FuncCall.build("to_network",
-									 "&#{parent}#{@name}",
+									 "&#{parent}#{this_name}",
 									 "&buffer[#{offset}]")
 		f_call.args.dont_wrap = true
 	end
-	def toHost(offset,suite, parent = "")
+	def toHost(offset,suite, parent = "", this_name=nil)
+    if (this_name == nil)
+      this_name = @name
+    end
 		suite << f_call = CPP::FuncCall.build("to_host",
 									 "&buffer[#{offset}]",
-									 "&#{parent}#{@name}")
+									 "&#{parent}#{this_name}")
 		f_call.args.dont_wrap = true
 	end
 	def getTypeID()
@@ -271,57 +286,112 @@
 	def simpleStr()
 		"#{@type} #{@name}"
 	end
-	def set_message_builder(suite)
-		suite << "msg_ptr_->#{@name} = #{@name}"
+	def set_message_builder(suite, this_name=nil)
+    this_name ||= @name
+		suite << "msg_ptr_->#{this_name} = #{this_name}"
 	end
 
-	def zeroCall(suite, parent = "")
-		suite << CPP::Assign.new(parent + @name,@zero)
+	def zeroCall(suite, parent = "", this_name=nil)
+    if (this_name == nil)
+      this_name = @name
+    end
+		suite << CPP::Assign.new(parent + this_name,@zero)
 	end
-	def fetchPrintArgs(args, parent = "")
-		if (self.type == 'bool')
-			args.push("#{parent}#{self.name} ? 'T' : 'f'")
-    elsif (self.type == '::aos::time::Time')
-      args.push("AOS_TIME_ARGS(#{parent}#{self.name}.sec(), #{parent}#{self.name}.nsec())")
+	def fetchPrintArgs(args, parent = "", this_name=nil)
+    if (this_name == nil)
+      this_name = @name
+    end
+		if (@type == 'bool')
+			args.push("#{parent}#{this_name} ? 'T' : 'f'")
+    elsif (@type == '::aos::time::Time')
+      args.push("AOS_TIME_ARGS(#{parent}#{this_name}.sec(), #{parent}#{this_name}.nsec())")
 		else
-			args.push("#{parent}#{self.name}")
+			args.push("#{parent}#{this_name}")
 		end
 	end
 end
 class Target::MessageArrayElement < Target::Node
-	attr_accessor :name,:loc,:size,:zero,:type
-	def initialize(type,name,length)
-		@type,@name,@length = type,name,length
+	attr_accessor :loc, :length
+	def initialize(type,length)
+		@type,@length = type,length
 	end
-	def create_usage(cpp_tree)
-		"#{@type} #{@name}[#@length]"
+  def zero()
+    return @type.zero()
+  end
+  def name()
+    return @type.name()
+  end
+
+  def add_TypeRegister(*args)
+    if @type.respond_to?(:add_TypeRegister)
+      @type.add_TypeRegister(*args)
+    end
+  end
+
+	def toPrintFormat()
+		return ([@type.toPrintFormat] * @length).join(", ")
+	end
+	def create_usage(cpp_tree, this_name=nil)
+    if (this_name == nil)
+      this_name = name
+    end
+		return "::std::array< #{@type.type_name(cpp_tree)}, #{@length}> #{this_name}"
 	end
 	def type()
-		"#{@type}[#@length]"
+		return "::std::array< #{@type.type()}, #{@length}>"
+	end
+	def simpleStr()
+		return "#{@type.type} #{@name}[#{@length}]"
+	end
+	def getTypeID()
+    return @type.getTypeID()
 	end
 	def size()
-		@size * @length
+		return @type.size * @length
 	end
-	def toNetwork(offset,suite)
+	def toNetwork(offset, suite, parent="", this_name=nil)
+    if (this_name == nil)
+      this_name = name
+    end
 		offset = (offset == 0) ? "" : "#{offset} + "
-		suite << for_stmt = CPP::For.new("int i = 0","i < #{@length}","i++")
-		for_stmt.suite << f_call = CPP::FuncCall.build("to_network",
-									 "&(#{@name}[i])",
-									 "&buffer[i + #{offset}::aos::Message::Size()]")
-		f_call.args.dont_wrap = true
+    for_loop_var = getForLoopVar()
+		suite << for_stmt = CPP::For.new("int #{for_loop_var} = 0","#{for_loop_var} < #{@length}","#{for_loop_var}++")
+		@type.toNetwork("#{offset} (#{for_loop_var} * #{@type.size})", for_stmt.suite, parent, "#{this_name}[#{for_loop_var}]")
 	end
-	def toHost(offset,suite)
+	def toHost(offset, suite, parent="", this_name=nil)
+    if (this_name == nil)
+      this_name = name
+    end
 		offset = (offset == 0) ? "" : "#{offset} + "
-		suite << for_stmt = CPP::For.new("int i = 0","i < #{@length}","i++")
-		for_stmt.suite << f_call = CPP::FuncCall.build("to_host",
-									 "&buffer[i + #{offset}::aos::Message::Size()]",
-									 "&(#{@name}[i])")
-		f_call.args.dont_wrap = true
+    for_loop_var = getForLoopVar()
+		suite << for_stmt = CPP::For.new("int #{for_loop_var} = 0","#{for_loop_var} < #{@length}","#{for_loop_var}++")
+		@type.toHost("#{offset} (#{for_loop_var} * #{@type.size})", for_stmt.suite, parent, "#{this_name}[#{for_loop_var}]")
 	end
-	def set_message_builder(suite)
-		suite << "memcpy(msg_ptr_->#{@name},#{@name},#@length)"
+	def set_message_builder(suite, this_name=nil)
+    if (this_name == nil)
+      this_name = name
+    end
+
+    for_loop_var = getForLoopVar()
+		suite << for_stmt = CPP::For.new("int #{for_loop_var} = 0","#{for_loop_var} < #{@length}","#{for_loop_var}++")
+		@type.set_message_builder(for_stmt.suite, "#{this_name}[#{for_loop_var}]")
 	end
-	def zeroCall(suite)
-		suite << "memset(#@name,0,#{size()})"
+	def zeroCall(suite, parent="", this_name=nil)
+    if (this_name == nil)
+      this_name = name
+    end
+
+		offset = (offset == 0) ? "" : "#{offset} + "
+    for_loop_var = getForLoopVar()
+		suite << for_stmt = CPP::For.new("int #{for_loop_var} = 0","#{for_loop_var} < #{@length}","#{for_loop_var}++")
+		@type.zeroCall(for_stmt.suite, parent, "#{this_name}[#{for_loop_var}]")
+	end
+	def fetchPrintArgs(args, parent = "", this_name=nil)
+    if (this_name == nil)
+      this_name = name
+    end
+    for i in 0..(@length-1)
+		  @type.fetchPrintArgs(args, parent, "#{this_name}[#{i}]")
+    end
 	end
 end
diff --git a/aos/build/queues/output/q_file.rb b/aos/build/queues/output/q_file.rb
index a39799d7..471bdcb 100644
--- a/aos/build/queues/output/q_file.rb
+++ b/aos/build/queues/output/q_file.rb
@@ -4,6 +4,12 @@
   require "digest/sha1"
 end
 
+$i = 0
+def getForLoopVar()
+  $i = $i + 1
+  return "_autogen_index_#{$i}"
+end
+
 module Target
 end
 class Target::Node
@@ -30,6 +36,7 @@
 	end
 	def make_cpp_tree(rel_path)
 		cpp_tree = DepFilePair.new(rel_path)
+		cpp_tree.add_header_include("<array>")
 		cpp_tree.add_header_include("\"aos/common/macros.h\"")
 		cpp_tree.add_header_include("\"aos/common/queue.h\"")
 		@class_types.each do |type|
diff --git a/aos/build/queues/output/q_struct.rb b/aos/build/queues/output/q_struct.rb
index 05c2932..7211ff0 100644
--- a/aos/build/queues/output/q_struct.rb
+++ b/aos/build/queues/output/q_struct.rb
@@ -85,29 +85,47 @@
 	def toPrintFormat()
 		@type.getPrintFormat()
 	end
-	def create_usage(cpp_tree)
-		return "#{type_name(cpp_tree)} #{@name}"
+	def create_usage(cpp_tree, this_name=nil)
+    if (this_name == nil)
+      this_name = @name
+    end
+		return "#{type_name(cpp_tree)} #{this_name}"
 	end
 	def add_TypeRegister(cpp_tree, o_type, member_func)
 		type = cpp_tree.get(@type)
 		tName = @type.loc.to_cpp_id(type.name)
 		member_func.suite << "#{tName}::GetType()"
 	end
-	def fetchPrintArgs(args, parent = "")
-		@type.fetchPrintArgs(args, parent + "#{@name}.")
+	def fetchPrintArgs(args, parent = "", this_name=nil)
+    if (this_name == nil)
+      this_name = @name
+    end
+		@type.fetchPrintArgs(args, parent + "#{this_name}.")
 	end
-	def toNetwork(offset,suite, parent = "")
-		@type.toNetwork(offset, suite, parent + "#{@name}.")
+	def toNetwork(offset,suite, parent = "", this_name=nil)
+    if (this_name == nil)
+      this_name = @name
+    end
+		@type.toNetwork(offset, suite, parent + "#{this_name}.")
 	end
-	def toHost(offset,suite, parent = "")
-		@type.toHost(offset, suite, parent + "#{@name}.")
+	def toHost(offset,suite, parent = "", this_name=nil)
+    if (this_name == nil)
+      this_name = @name
+    end
+		@type.toHost(offset, suite, parent + "#{this_name}.")
 	end
-	def set_message_builder(suite)
-		suite << "msg_ptr_->#{@name} = #{@name}"
+	def set_message_builder(suite, this_name=nil)
+    if (this_name == nil)
+      this_name = @name
+    end
+		suite << "msg_ptr_->#{this_name} = #{this_name}"
 	end
 
-	def zeroCall(suite, parent = "")
-		@type.zeroCall(suite, parent + "#{@name}.")
+	def zeroCall(suite, parent = "", this_name=nil)
+    if (this_name == nil)
+      this_name = @name
+    end
+		@type.zeroCall(suite, parent + "#{this_name}.")
 	end
 	def simpleStr()
 		"#{@type.simpleStr()} #{@name}"