Avans/Controller
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Fixed for controller case

Browse Source
This commit is contained in:
jancoow
2016-06-22 01:12:08 +02:00
parent bdd86ac036
commit 270144935a
1 changed files with 5 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
Controller/Controller.ino
+5
View File
@@ -196,6 +196,10 @@ void readMpu6050(struct MPU6050Data *mpu6050data){
mpu6050data->pitch = pitch*100;
mpu6050data->roll = roll*100;
mpu6050data->yaw = 0;
mpu6050data->ax = ax_scaled;
mpu6050data->ay = ay_scaled;
mpu6050data->az = az_scaled;
}
void readJoystick(struct JoystickData *joystickdata){
@@ -296,6 +300,7 @@ void sendUdpMessage(struct JoystickData *joystick, struct MPU6050Data *mpu6050da
sprintf(sendBuffer, "%06d|%06d|%01d|", joystick->x, joystick->y, joystick->button);
sprintf(sendBuffer, "%s%06d|%06d|%06d|", sendBuffer, mpu6050data->yaw, mpu6050data->pitch, mpu6050data->roll);
sprintf(sendBuffer, "%s%01d|%01d", sendBuffer, switchdata->backSwitch, switchdata->magnetSwitch);
sprintf(sendBuffer, "%s%06d|%06d|%06d", sendBuffer, mpu6050data->ax, mpu6050data->ay, mpu6050data->az);
Serial.printf("%s", sendBuffer);
Serial.println();
Udp.write(sendBuffer);