Craft Club
Master Swordの吹奏楽部展示時用のプログラムです
Fork of
MIYABI_Drive
by 
Nin_PTD_Mecha
Revision 3:3707e3934185, committed 2018-09-18
- Comitter:
- iwaki
- Date:
- Tue Sep 18 04:35:28 2018 +0000
- Parent:
- 2:41795d8bc7cb
- Commit message:
- MasterSword?
Changed in this revision
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Text_LCD/TextLCD.lib Tue Sep 18 04:35:28 2018 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/simon/code/TextLCD/#44f34c09bd37
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Text_LCD/mbed.bld Tue Sep 18 04:35:28 2018 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/mbed_official/code/mbed/builds/10b9abbe79a6 \ No newline at end of file
--- a/Text_LCD_Hello/TextLCD.lib Thu Jul 27 11:31:52 2017 +0000 +++ /dev/null Thu Jan 01 00:00:00 1970 +0000 @@ -1,1 +0,0 @@ -http://mbed.org/users/simon/code/TextLCD/#44f34c09bd37
--- a/Text_LCD_Hello/mbed.bld Thu Jul 27 11:31:52 2017 +0000 +++ /dev/null Thu Jan 01 00:00:00 1970 +0000 @@ -1,1 +0,0 @@ -http://mbed.org/users/mbed_official/code/mbed/builds/10b9abbe79a6 \ No newline at end of file
--- a/main.cpp Thu Jul 27 11:31:52 2017 +0000
+++ b/main.cpp Tue Sep 18 04:35:28 2018 +0000
@@ -1,6 +1,6 @@
#include "mbed.h"
#include "TextLCD.h"
-
+#include "math.h"
PwmOut led1(LED1);
PwmOut led2(LED2);
PwmOut led3(LED3);
@@ -12,65 +12,113 @@
TextLCD lcd(p24, p26, p27, p28, p29, p30); // rs, e, d0-d3
+void Change_Shine(bool BRIGHT){
+
+ int i;
+
+ int t_BecameShine;
+ int t_MaxShine;
+ int t_MinShine;
+ int t_NotShine;
+
+ float rate;
+ float rate_l;
+ float Out1;
+ float Out2;
+
+ i = 0;
+
+ Out1 = 0.0;
+ Out2 = 0.0;
+ t_BecameShine = 2000;
+ t_MaxShine = 150;
+ t_MinShine = 400;
+ t_NotShine = 1200;
+ rate = 0.7;
+ rate_l = 0.4;
+
+
+ if(BRIGHT){
+ lcd.cls(); //clear
+ lcd.locate(0,0);
+ lcd.printf("Shining now");
+ for(i=0;i <= t_BecameShine ;i++){
+
+ if(i <= t_MaxShine){
+ Out1 = (float)i / t_MaxShine;
+ Out2 = (float)i / t_MaxShine;
+ }
+ else if(i <= t_MinShine) {
+ Out1 = (float) 1 - (1 - rate_l)*(i - t_MaxShine)/(t_MinShine - t_MaxShine);
+ }
+ else{
+ Out1 = (float) 1 *(rate - rate_l)*(i - t_MinShine)/(t_BecameShine - t_MinShine) +rate_l;
+ }
+
+ lcd.locate(0,1);
+ lcd.printf("%f" ,Out1);
+
+ moter1 = Out1;
+ moter2 = Out1;
+ wait(0.001);
+ }
+ moter1 = rate;
+ moter2 = rate;
+ }
+ else{
+ lcd.cls(); //clear
+ lcd.locate(0,0);
+ lcd.printf("Not shining now");
+ moter1 = rate;
+ moter2 = rate;
+ for(i=0;i<=t_NotShine;i++){
+ Out1 = float(rate*(t_NotShine - i)/t_NotShine);
+ Out2 = float(rate*(t_NotShine - i)/t_NotShine);
+ lcd.locate(0,1);
+ lcd.printf("%f" ,Out1);
+ moter1 = Out1;
+ moter2 = Out2;
+ wait(0.001);
+ }
+ moter1 = 0;
+ moter2 = 0;
+ }
+}
+
int main() {
- int i;
- int s;
- int n;
-
- i = 0;
- s = 0;
- n = 100;
+ int s = 0;
+ bool BRIGHT = false;
sw1.mode( PullUp );
+
moter1 = 0.0;
moter2 = 0.0;
-
- //離れての表示と、動作待ちの5秒待機
- lcd.cls();
- lcd.locate(0,0);
- lcd.printf("Ready to start");
- lcd.locate(0,1);
- lcd.printf("Don't touch me");
- wait(5);
-
- //モータ出力ON
- moter1 = 0.1;
- moter2 = 0.1;
-
- while(1) {
-
- //クリック回数のカウント
+ moter1.period(0.001);
+ moter2.period(0.001);
+
+ //初期設定を光らないモードに設定
+ lcd.cls(); //clear
+ lcd.locate(0,0);
+ lcd.printf("Not shining now");
+
+ while(1){
+ //トリガのみのカウント
//チャタリング防止のためタイマ有り
- //一度OFFになったことを検知するステータスフラグあり
+ //一度OFFになったことを検知するステータスフラグ、点灯消灯フラグを用い
+ //１回だけ点灯消灯の関数を呼び出す。
if(sw1 == 0 and s == 0) {
s = 1;
- i++;
- wait(0.0001);
+ led1 = 1;
+ BRIGHT = !BRIGHT;
+ Change_Shine(BRIGHT);
+ wait(0.001);
}
else if(sw1 == 1) {
s = 0;
- }
-
- //LCDへの回数の記載
- lcd.cls();
- lcd.locate(0,0);
- lcd.printf("%d",i);
-
- //テスト中か、終了したかのLCDへの記載
- if( n > i ) {
- lcd.locate(0,1);
- lcd.printf("testing");
+ led1 = 0;
}
- else {
- lcd.locate(0,1);
- lcd.printf("End");
-
- moter1 = 0;
- moter2 = 0;
- }
-
- //LCDへの記載を安定させるための待機
- wait(0.05);
- }
+ wait(0.1);
+ }
+
}