Skip to content

Run a virtual iPhone on an Apple Silicon Mac.

Swift
3.3 KB
Raw Blame
#import "VPhoneAttitudeSample.h"
#include <assert.h>

static void closeTo(double actual, double expected) { assert(fabs(actual - expected) < 1e-9); }

int main(void) {
    @autoreleasepool {
        VPhoneAttitudeState state = {YES, 32.5, -24.25, 117.75}, decoded;
        assert(VPhoneAttitudeDecode(VPhoneAttitudeEncode(state), &decoded));
        closeTo(decoded.roll, state.roll);
        for (NSDictionary *invalid in @[
            @{@"enabled": @YES, @"roll": @YES, @"pitch": @0, @"yaw": @0},
            @{@"enabled": @1, @"roll": @0, @"pitch": @0, @"yaw": @0},
            @{@"enabled": @YES, @"roll": @181, @"pitch": @0, @"yaw": @0},
            @{@"enabled": @YES, @"roll": @0, @"pitch": @91, @"yaw": @0},
            @{@"enabled": @YES, @"roll": @0, @"pitch": @0, @"yaw": @(NAN)},
        ]) assert(!VPhoneAttitudeDecode(invalid, &decoded));
        VPhoneAttitudeState poses[] = {state, {NO, -180, -90, -180}, {YES, 180, 90, 180}, {YES, 0, 0, 0}};
        for (NSUInteger i = 0; i < sizeof(poses)/sizeof(*poses); i++) {
            decoded = VPhoneAttitudeUnpack(VPhoneAttitudePack(poses[i]));
            assert(decoded.enabled == poses[i].enabled);
            closeTo(decoded.roll, poses[i].roll); closeTo(decoded.pitch, poses[i].pitch); closeTo(decoded.yaw, poses[i].yaw);
        }
        assert(!VPhoneAttitudeUnpack(0).enabled);
        assert(!VPhoneAttitudeUnpack(UINT64_MAX).enabled);
        VPhoneAttitudeSample *sample = [[VPhoneAttitudeSample alloc] initWithState:state timestamp:123];
        CMAttitude *pose = sample.attitude;
        closeTo(pose.roll, state.roll*M_PI/180); closeTo(pose.pitch, state.pitch*M_PI/180); closeTo(pose.yaw, state.yaw*M_PI/180);
        CMQuaternion q = pose.quaternion;
        closeTo(q.x*q.x+q.y*q.y+q.z*q.z+q.w*q.w, 1);
        CMRotationMatrix m = pose.rotationMatrix;
        closeTo(m.m11*m.m11+m.m12*m.m12+m.m13*m.m13, 1);
        closeTo(m.m11*m.m21+m.m12*m.m22+m.m13*m.m23, 0);
        CMAcceleration g = sample.gravity;
        closeTo(g.x*g.x+g.y*g.y+g.z*g.z, 1);
        closeTo(sample.rotationRate.x, 0); closeTo(sample.userAcceleration.y, 0); closeTo(sample.timestamp, 123);
        assert(sample.heading < 0 && sample.magneticField.accuracy == CMMagneticFieldCalibrationAccuracyUncalibrated);
        CMAttitude *copy = [pose copy];
        [copy multiplyByInverseOfAttitude:pose];
        closeTo(copy.quaternion.w, 1); closeTo(copy.roll, 0); closeTo(copy.pitch, 0); closeTo(copy.yaw, 0);
        closeTo(pose.roll, state.roll*M_PI/180);
        NSError *error;
        NSData *archive = [NSKeyedArchiver archivedDataWithRootObject:sample requiringSecureCoding:YES error:&error];
        assert(archive && !error);
        VPhoneAttitudeSample *restored = [NSKeyedUnarchiver unarchivedObjectOfClass:VPhoneAttitudeSample.class fromData:archive error:&error];
        assert(restored && !error);
        closeTo(restored.attitude.yaw, pose.yaw); closeTo(restored.timestamp, 123);
        VPhoneAttitudeSample *pitch = [[VPhoneAttitudeSample alloc] initWithState:(VPhoneAttitudeState){YES, 0, 90, 0} timestamp:0];
        closeTo(pitch.gravity.y, -1);
        VPhoneAttitudeSample *roll = [[VPhoneAttitudeSample alloc] initWithState:(VPhoneAttitudeState){YES, 90, 0, 0} timestamp:0];
        closeTo(roll.gravity.x, 1);
        puts("Attitude configuration, quaternion, gravity, copy and coding tests passed");
    }
    return 0;
}