brendanhaines/javaProcessing
1
0
Fork 0
mirror of https://github.com/brendanhaines/javaProcessing.git synced 2024-12-25 10:26:59 -07:00
Code Issues Packages Projects Releases Wiki Activity

makes Tester3D automatically zero yaw on startup

Browse Source
This commit is contained in:
Brendan Haines 2015-05-08 20:57:59 -06:00
parent 4c70857693
commit d725be34b6
1 changed files with 23 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

32
Tester3D.java
View File

@ -58,19 +58,16 @@ class Tester3D {
while( !in.ready() ) {}
String inString;
while( !in2.hasNext() ) {}
while( !updateYPR( in2 ) ) {}
yawAdjust = rawYaw;
while( true ) {
//while( !in.ready() ) {}
//inString = in.readLine();
if( in2.hasNext() ) {
if( in2.next().equals( "ypr" ) ) {
while( !in2.hasNext() ) {}
rawYaw = (float)( 0.01745329251 * in2.nextFloat() );
area3d.yaw = (float)( rawYaw - yawAdjust );
while( !in2.hasNext() ) {}
area3d.pitch = (float)( 0.01745329251 * in2.nextFloat() );
while( !in2.hasNext() ) {}
area3d.roll = (float)( 0.01745329251 * in2.nextFloat() );
}
updateYPR( in2 );
}
}
//System.out.print("'\n");
@ -80,4 +77,21 @@ class Tester3D {
System.out.print("Whoops! It didn't work!\n");
}
}
/**
* @return true on successful update, false if scan.next() is not "ypr"
*/
public static boolean updateYPR( Scanner scan) {
if( scan.next().equals( "ypr" ) ) {
while( !scan.hasNext() ) {}
rawYaw = (float)( 0.01745329251 * scan.nextFloat() );
area3d.yaw = (float)( rawYaw - yawAdjust );
while( !scan.hasNext() ) {}
area3d.pitch = (float)( 0.01745329251 * scan.nextFloat() );
while( !scan.hasNext() ) {}
area3d.roll = (float)( 0.01745329251 * scan.nextFloat() );
return true;
}
return false;
}
}