简易半自动和弦辅助演奏装置

vany5921

    只需在M5stickC上连接舵机，通过加速度传感器检测姿势并按压琴弦，超简单。按压的和弦是FM7。虽然出现频率不高，但是平时使用的1-3品移动的话会比较远，所以试着自动化了。

固定也只是用金属零件夹着达米亚的通用板。

安装支架是用3D打印机制作的。

源代码也非常简单。

1. #include <M5StickC.h> #include "utility/M5Servo.h"//M5Servo.hをM5StickC/utilityフォルダに入れておく
   
2. 
   
3. float accX = 0.0F;
   
4. float accY = 0.0F;
   
5. float accZ = 0.0F;
   
6. float gyroX = 0.0F;
   
7. float gyroY = 0.0F;
   
8. float gyroZ = 0.0F;
   
9. float pitch = 0.0F;
   
10. float roll  = 0.0F;
    
11. float yaw   = 0.0F;
    
12. 
    
13. //把阈值调整到合适的值
    
14. float accX_max = -0.92F; //X轴阈值
    
15. float accY_max = 0.30F; //Y轴阈值
    
16. float accZ_max = 1.5F; //Z轴阈值
    
17. float gyroX_max = 0.5F; //X轴阈值
    
18. float gyroY_max = 0.5F; //Y轴阈值
    
19. float gyroZ_max = 1.5F; //Z轴阈值
    
20. 
    
21. int pmin = ((0.5 / 20) * 1024) + 0.5; // (0.5ms/20ms)*1024 + 0.5(四舍五入) = 26 (-90°)
    
22. int pmax = ((2.4 / 20) * 1024) + 0.5; // (2.4ms/20ms)*1024 + 0.5(四舍五入) = 123 (+90°)
    
23. int pd = 1;
    
24. int p = pmin;
    
25. 
    
26. M5Servo myServo;//舵机类实例化
    
27. void setup() {
    
28. 
    
29. M5.begin();
    
30. M5.MPU6886.Init();
    
31. M5.Lcd.setRotation(3);
    
32. M5.Lcd.fillScreen(BLACK);
    
33. M5.Lcd.setTextSize(1);
    
34. M5.Lcd.setCursor(0, 15);
    
35. M5.Lcd.println("  X       Y       Z");
    
36. pinMode(10, OUTPUT); //内置LED
    
37. myServo.attach(26);//GPIO26pin接舵机
    
38. }
    
39. 
    
40. void loop() {
    
41. M5.MPU6886.getGyroData(&gyroX, &gyroY, &gyroZ);//获取角速度
    
42. M5.MPU6886.getAccelData(&accX, &accY, &accZ);//获取加速度
    
43. M5.Lcd.setCursor(0, 30);//显示角速度值
    
44. M5.Lcd.printf("%6.2f  %6.2f  %6.2f      ", gyroX, gyroY, gyroZ);
    
45. M5.Lcd.setCursor(140, 30);
    
46. M5.Lcd.print("o/s");
    
47. M5.Lcd.setCursor(0, 45);//显示加速度值
    
48. M5.Lcd.printf(" %5.2f   %5.2f   %5.2f   ", accX, accY, accZ);
    
49. M5.Lcd.setCursor(140, 45);
    
50. M5.Lcd.print("G");
    
51. ledcWrite(0, p);
    
52. Serial.printf("p = %d\n", p);
    
53. 
    
54. // 修改值
    
55. p += pd;
    
56. if (p > pmax) {
    
57.    p = pmax;
    
58.    pd = -pd;
    
59. } else if (pmin > p) {
    
60.    p = pmin;
    
61.    pd = -pd;
    
62. }
    
63. 
    
64. delay(100);
    
65. //把阈值调整到合适的值
    
66. if (accX_max < accX & accY > accY_max ) {
    
67.    digitalWrite(10, LOW); //LED亮灯※注意LOW亮灯
    
68.    myServo.write(-18);//按弦的角度调整到合适位置
    
69. }
    
70. else {
    
71.    digitalWrite(10, HIGH); //LED灭
    
72.    myServo.write(20);//离弦
    
73. }
    
74. delay(100);
    
75. }

复制代码