add servo control

Author: marty5499

blockly.json

@@ -1,5 +1,5 @@
 {
-    "types": ["wabot_new", "wabot_step","wabot_backyard","wabot_turn","wabot_action","wabot_tempo"],
+    "types": ["wabot_new", "wabot_step", "wabot_backyard", "wabot_turn", "wabot_action", "wabot_tempo", "wabot_servo"],
     "category": "catMenu3",
     "scripts": [
         "blockly/blocks.js",

blockly/blocks.js

@@ -10,6 +10,29 @@ Blockly.Blocks['wabot_new'] = {
 };
 
 
+Blockly.Blocks['wabot_servo'] = {
+    init: function() {
+        this.appendValueInput("servo")
+            .setCheck(null)
+            .appendField(new Blockly.FieldVariable("wabot"), "wabot")
+            .appendField("設定")
+            .appendField(new Blockly.FieldDropdown([
+                ["右足", "0"],
+                ["左足", "1"],
+                ["右腿", "2"],
+                ["左腿", "3"],
+                ["左手", "4"],
+                ["右手", "5"]
+            ]), "n");
+        this.setPreviousStatement(true, null);
+        this.setNextStatement(true, null);
+        this.setColour(65);
+        this.setTooltip('');
+        this.setHelpUrl('https://webduino.io');
+    }
+};
+
+
 Blockly.Blocks['wabot_step'] = {
     init: function() {
         this.appendValueInput("step")

blockly/javascript.js

@@ -11,6 +11,14 @@ Blockly.JavaScript['wabot_walk'] = function(block) {
     return code;
 };
 
+Blockly.JavaScript['wabot_servo'] = function(block) {
+    var variable_ = Blockly.JavaScript.variableDB_.getName(block.getFieldValue('wabot'), Blockly.Variables.NAME_TYPE);
+    var dropdown_n = block.getFieldValue('n');
+    var value_servo = Blockly.JavaScript.valueToCode(block, 'servo', Blockly.JavaScript.ORDER_ATOMIC);
+    var code = variable_ + '.servo(' + dropdown_n + ',' + value_servo + ',function(){});\n';
+    return code;
+};
+
 Blockly.JavaScript['wabot_step'] = function(block) {
     var variable_ = Blockly.JavaScript.variableDB_.getName(block.getFieldValue('wabot'), Blockly.Variables.NAME_TYPE);
     var dropdown_step = block.getFieldValue('step');

blockly/toolbox.xml

@@ -41,4 +41,11 @@
       </block>
     </value>
   </block>
+  <block type="wabot_servo">
+    <value name="servo">
+      <block type="math_number">
+        <field name="NUM">90</field>
+      </block>
+    </value>
+  </block>
 </category>

wabot.js

@@ -43,6 +43,14 @@
         }
     });
 
+    proto.servo = function(n, pos, callback) {
+        this.callback['servo'] = callback;
+        var a1 = (pos & 0xf0) >> 4,
+            a2 = (pos & 0x0f);
+        var cmd = [0xF0, 0x04, SENSOR_WABOT, 0x20, n, a1, a2, 0xF7];
+        this._board.send(cmd);
+    }
+
     proto.standard = function(step, callback) {
         this.callback['standard'] = callback;
         var cmd = [0xF0, 0x04, SENSOR_WABOT, 0x01, 0, 0xF7];