0913 hikitugi

Dependencies:   mbed SBDBT BNO055 YKNCT_MD YKNCT_I2C

Revision:
0:ad3dd7fb650a
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/target.h	Mon Sep 13 02:40:49 2021 +0000
@@ -0,0 +1,56 @@
+#include <main.h>
+
+/* 目標地点数 */
+const int TargetMAX = 46;
+
+/* 目標座標 X,Y,Theta,Time(ms) ジャグ機構 竿射出 リボン回転 */
+const COORDINATE Target[TargetMAX] = {
+    {2000*cos(8/8.0 * PI), 2000*sin(8/8.0 * PI), 0, 20000*0/4 ,0 ,0 ,0},
+    {2000*cos(7/8.0 * PI), 2000*sin(7/8.0 * PI), 0, 20000*1/4 ,0 ,0 ,0},
+    {2000*cos(6/8.0 * PI), 2000*sin(6/8.0 * PI), 0, 20000*2/4 ,0 ,0 ,0},
+    {2000*cos(5/8.0 * PI), 2000*sin(5/8.0 * PI), 0, 20000*3/4 ,0 ,0 ,0},
+    {2000*cos(4/8.0 * PI), 2000*sin(4/8.0 * PI), 0, 20000*4/4 ,0 ,0 ,0},
+    {0, 2000, 0, 37000 ,1 ,0 ,0},
+    {0, 2000, 0, 40000 ,0 ,0 ,0},
+    {2000*cos(5/8.0 * PI), 2000*sin(5/8.0 * PI), 0, 40000+5000*1/4 ,0 ,0 ,0},
+    {2000*cos(6/8.0 * PI), 2000*sin(6/8.0 * PI), 0, 40000+5000*2/4 ,0 ,0 ,0},
+    {2000*cos(7/8.0 * PI), 2000*sin(7/8.0 * PI), 0, 40000+5000*3/4 ,0 ,0 ,0},
+    {2000*cos(8/8.0 * PI), 2000*sin(8/8.0 * PI), 0, 40000+5000*4/4 ,0 ,0 ,0},
+    {-2000, -2000, 0, 50000 ,0 ,0 ,0},
+    {2000, -2000, 0, 60000 ,0 ,0 ,1},//上げる
+    {2000, -2000, 720, 70000 ,0 ,0 ,1},//回転
+    {2000, 0, 720, 75000 ,0 ,0 ,0},//円開始
+    {2000, 0, 720, 76000 ,0 ,0 ,0},//円開始
+    {2000*cos(16/8.0 * PI), 2000*sin(16/8.0 * PI), 720, 76000+22000*0/24 ,0 ,0 ,0},
+    {2000*cos(15/8.0 * PI), 2000*sin(15/8.0 * PI), 720, 76000+22000*1/24 ,0 ,0 ,0},
+    {2000*cos(14/8.0 * PI), 2000*sin(14/8.0 * PI), 720, 76000+22000*2/24 ,0 ,0 ,0},
+    {2000*cos(13/8.0 * PI), 2000*sin(13/8.0 * PI), 720, 76000+22000*3/24 ,0 ,0 ,0},
+    {2000*cos(12/8.0 * PI), 2000*sin(12/8.0 * PI), 720, 76000+22000*4/24 ,0 ,0 ,0},
+    {2000*cos(11/8.0 * PI), 2000*sin(11/8.0 * PI), 720, 76000+22000*5/24 ,0 ,0 ,0},
+    {2000*cos(10/8.0 * PI), 2000*sin(10/8.0 * PI), 720, 76000+22000*6/24 ,0 ,0 ,0},
+    {2000*cos(9/8.0 * PI), 2000*sin(9/8.0 * PI), 720, 76000+22000*7/24 ,0 ,0 ,0},
+    {2000*cos(8/8.0 * PI), 2000*sin(8/8.0 * PI), 720, 76000+22000*8/24 ,0 ,0 ,0},
+    {2000*cos(7/8.0 * PI), 2000*sin(7/8.0 * PI), 720, 76000+22000*9/24 ,0 ,0 ,0},
+    {2000*cos(6/8.0 * PI), 2000*sin(6/8.0 * PI), 720, 76000+22000*10/24 ,0 ,0 ,0},
+    {2000*cos(5/8.0 * PI), 2000*sin(5/8.0 * PI), 720, 76000+22000*11/24 ,0 ,0 ,0},
+    {2000*cos(4/8.0 * PI), 2000*sin(4/8.0 * PI), 720, 76000+22000*12/24 ,0 ,0 ,0},
+    {2000*cos(3/8.0 * PI), 2000*sin(3/8.0 * PI), 720, 76000+22000*13/24 ,0 ,0 ,0},
+    {2000*cos(2/8.0 * PI), 2000*sin(2/8.0 * PI), 720, 76000+22000*14/24 ,0 ,0 ,0},
+    {2000*cos(1/8.0 * PI), 2000*sin(1/8.0 * PI), 720, 76000+22000*15/24 ,0 ,0 ,0},
+    {2000*cos(0/8.0 * PI), 2000*sin(0/8.0 * PI), 720, 76000+22000*16/24 ,0 ,0 ,0},
+    {2000*cos(-1/8.0 * PI), 2000*sin(-1/8.0 * PI), 720, 76000+22000*17/24 ,0 ,0 ,0},
+    {2000*cos(-2/8.0 * PI), 2000*sin(-2/8.0 * PI), 720, 76000+22000*18/24 ,0 ,0 ,0},
+    {2000*cos(-3/8.0 * PI), 2000*sin(-3/8.0 * PI), 720, 76000+22000*19/24 ,0 ,0 ,0},
+    {2000*cos(-4/8.0 * PI), 2000*sin(-4/8.0 * PI), 720, 76000+22000*20/24 ,0 ,0 ,0},
+    {2000*cos(-5/8.0 * PI), 2000*sin(-5/8.0 * PI), 720, 76000+22000*21/24 ,0 ,0 ,0},
+    {2000*cos(-6/8.0 * PI), 2000*sin(-6/8.0 * PI), 720, 76000+22000*22/24 ,0 ,0 ,0},
+    {2000*cos(-7/8.0 * PI), 2000*sin(-7/8.0 * PI), 720, 76000+22000*23/24 ,0 ,0 ,0},
+    {2000*cos(-8/8.0 * PI), 2000*sin(8/8.0 * PI), 720, 76000+22000*24/24 ,0 ,0 ,0},
+    {-2000, 2000, 585, 103000 ,0 ,0 ,0},
+    {-2000, 2000, 585, 105000 ,0 ,0 ,0},
+    {-2000, 2000, 585, 110000 ,0 ,1 ,0},//射出
+    {-2000, 2000, 180, 118000 ,0 ,0 ,0},
+    {-2000, 2000, 180, 120000 ,0 ,0 ,0},
+};
+extern const COORDINATE Target[TargetMAX];
+extern const int TargetMAX;
\ No newline at end of file