NHK2019 manual program(回収機構ストール問題解決)

Dependencies:   mbed PS3_10_26

Revision:
7:c423a6579c3c
Parent:
5:29971215ef50
Child:
8:959fe4717597
--- a/main.cpp	Sat Oct 26 04:39:03 2019 +0000
+++ b/main.cpp	Wed Oct 30 09:18:08 2019 +0000
@@ -14,6 +14,8 @@
 0x26:右ファン
 0x28:左ファン
 0x30:吐き出し機構
+0x36:スピーカー
+0x40:パトランプ
 */
 /////////////////////////////////////
 
@@ -47,6 +49,7 @@
 char data9;//左ファン
 char data10;//パトランプ
 char data11;//吐き出し機構
+char data_sound;//スピーカー
 char get_data_rs232=0x00;
 int Ry;
 int Rx;
@@ -175,6 +178,7 @@
     data10=0x80;
     data11=0x80;
     data_servo=0x00;
+    data_sound=0x80;
 
     send_data(0x10,data1);
     send_data(0x12,data2);
@@ -188,6 +192,7 @@
     send_data(0x40,data10);
     send_data(0x30,data11);
     send_data(0x18,data_servo);
+    send_data(0x36,data_sound);
     
 
     data10=0x3f;
@@ -332,11 +337,15 @@
                 led=0;
                 stop=1;
                 j=0;
+                data_sound=0x51;
+                send_data(0x36,data_sound);
             } else if(j==0) {
                 //緊急停止解除
                 led=1;
                 stop=0;
                 j=1;
+                data_sound=0x20;
+                send_data(0x36,data_sound);
             }
         }
     }