svn path=/trunk/; revision=205
ty = 0; y.forEach( function(n, i){ ty += n; } ); ty /= inertia;
tz = 0; z.forEach( function(n, i){ tz += n; } ); tz /= inertia;
ty = 0; y.forEach( function(n, i){ ty += n; } ); ty /= inertia;
tz = 0; z.forEach( function(n, i){ tz += n; } ); tz /= inertia;
- pitch = Math.asin((tz / 9.81 > 1)?1:(tz/9.81)) / Math.PI * 180;
+ pitch = Math.asin((tz / 9.81 > 1)?1:(tz/9.81)) / Math.PI * 180 + 22.5;
roll = - Math.asin((ty / 9.81 > 1)?1:(ty/9.81)) / Math.PI * 180;
yaw = (yaw + ty) % 360;
};
roll = - Math.asin((ty / 9.81 > 1)?1:(ty/9.81)) / Math.PI * 180;
yaw = (yaw + ty) % 360;
};