TAIWAN ALPHA 円形接触位置+感圧センサ 360度の使い方

/*
   TAIWAN ALPHA Membrane Force and Position Sensor Test Program
   https://ssci.to/6253
*/

void outputData(int force, int pos1, int pos2, int pos3) {
  Serial.print(force, DEC);
  Serial.print(",");
  Serial.print(pos1, DEC);
  Serial.print(",");
  Serial.print(pos2, DEC);
  Serial.print(",");
  Serial.print(pos3, DEC);

  int degree;
  if ((pos1 == 0) && (pos2 == 0) && (pos3 == 0)) {
    degree = 0;
  } else if (pos3 < 3) {
    degree = map(pos1, 1023, 0, 0, 119);
  } else if (pos1 < 3) {
    degree = map(pos2, 1023, 0, 120, 239);
  } else if (pos2 < 3) {
    degree = map(pos3, 1023, 0, 240, 359);
  } else {
    degree = 0;
  }
  Serial.print(",");
  Serial.println(degree, DEC);
}

void sensorRead(int* force, int* pos1, int* pos2, int* pos3) {
  pinMode(19, INPUT);  // 1
  pinMode(18, INPUT);  // 1'
  pinMode(14, INPUT);  // 1''
  delay(10);
  *force = analogRead(1);
  delay(10);

  pinMode(19, OUTPUT);  // 1
  pinMode(18, OUTPUT);  // 1'
  pinMode(14, OUTPUT);  // 1''
  digitalWrite(19, HIGH);
  digitalWrite(18, LOW);
  digitalWrite(14, LOW);
  delay(10);
  *pos1 = analogRead(2);
  delay(10);

  digitalWrite(19, LOW);  // 1
  digitalWrite(18, HIGH);  // 1'
  digitalWrite(14, LOW);  // 1''
  delay(10);
  *pos2 = analogRead(2);
  delay(10);

  digitalWrite(19, LOW);  // 1
  digitalWrite(18, LOW);  // 1'
  digitalWrite(14, HIGH);  // 1''
  delay(10);
  *pos3 = analogRead(2);
  delay(10);
}

// the setup function runs once when you press reset or power the board
void setup() {
  // initialize digital pin LED_BUILTIN as an output.
  Serial.begin(115200);
  pinMode(17, OUTPUT);  //
  digitalWrite(17, HIGH);
}

// the loop function runs over and over again forever
void loop() {
  int force;
  int pos1, pos2, pos3;
  sensorRead(&force, &pos1, &pos2, &pos3);

  outputData(force, pos1, pos2, pos3);

  delay(100);
}

import readline
import pyxel
import math
import serial
import time

pyxel.init(120, 80)
ser = serial.Serial('/dev/tty.usbserial-A9007U0F',115200,timeout = 1)
time.sleep(3)

while True:
    if ser.in_waiting > 7:
        raw_data = ser.readline().decode('utf-8')
        sensor_data = raw_data.strip().split(',')
        print(sensor_data)
        pyxel.cls(0)
        pyxel.text(1,1,"Press:",3)
        pyxel.text(1,7,"Pos 1:",3)
        pyxel.text(1,13,"Pos 2:",3)
        pyxel.text(1,19,"Pos 3:",3)
        pyxel.pset(80,40,3)
        pyxel.circb(80,40,int(sensor_data[0])/100,3)
        pyxel.circb(80,40,36,3)

        force = int(sensor_data[0])
        pos1 = int(sensor_data[1])
        pos2 = int(sensor_data[2])
        pos3 = int(sensor_data[3])
        circle_degree = int(sensor_data[4])

        posX = -math.sin(math.radians(circle_degree))*36
        posY = -math.cos(math.radians(circle_degree))*36
        pyxel.text(28,1,str(force),7)
        pyxel.text(28,7,str(pos1),7)
        pyxel.text(28,13,str(pos2),7)
        pyxel.text(27,19,str(pos3),7)

        pyxel.circb(int(posX)+80,int(posY)+40,5,7)
        pyxel.flip()