def check_accel_cal(conn):
'''check accel cal'''
global offset
offset = []
global scale_factor
scale_factor = []
for idx in range(NUM_ACCELS):
offset.append([])
scale_factor.append([])
if idx == 0:
n = ''
else:
n = '%u' % (idx + 1)
for axis in ['X', 'Y', 'Z']:
pname = 'INS_ACC%sOFFS_%s' % (n, axis)
ofs = util.param_value(conn.test, pname)
offset[idx].append(ofs)
if abs(ofs) < 1.0e-10:
util.failure(
"%s is zero - accel %u not calibrated (offset) %f" %
(pname, idx, ofs))
pname = 'INS_ACC%sSCAL_%s' % (n, axis)
ofs = util.param_value(conn.test, pname)
scale_factor[idx].append(ofs)
if abs(ofs - 1.0) < 1.0e-10:
util.failure("%s is zero - accel %u not calibrated (scale)" %
(pname, idx))
logger.info("Accel cal %u OK" % (idx + 1))
print "Accel Offsets:", offset
print "Accel Scale Factors:", scale_factor
def check_accel_cal(conn):
'''check accel cal'''
global offset
offset = []
global scale_factor
scale_factor = []
for idx in range(NUM_ACCELS):
offset.append([])
scale_factor.append([])
if idx == 0:
n = ''
else:
n = '%u' % (idx+1)
for axis in ['X', 'Y', 'Z']:
pname = 'INS_ACC%sOFFS_%s' % (n, axis)
ofs = util.param_value(conn.test, pname)
offset[idx].append(ofs)
if abs(ofs) < 1.0e-10:
util.failure("%s is zero - accel %u not calibrated (offset) %f" % (pname, idx, ofs))
pname = 'INS_ACC%sSCAL_%s' % (n, axis)
ofs = util.param_value(conn.test, pname)
scale_factor[idx].append(ofs)
if abs(ofs-1.0) < 1.0e-10:
util.failure("%s is zero - accel %u not calibrated (scale)" % (pname, idx))
logger.info("Accel cal %u OK" % (idx+1))
print "Accel Offsets:", offset
print "Accel Scale Factors:", scale_factor
def check_accel_cal(conn):
'''check accel cal'''
for idx in range(NUM_ACCELS):
if idx == 0:
n = ''
else:
n = '%u' % (idx+1)
for axis in ['X', 'Y', 'Z']:
pname = 'INS_ACC%sOFFS_%s' % (n, axis)
ofs = util.param_value(conn.test, pname)
if abs(ofs) < 1.0e-10:
util.failure("%s is zero - accel %u not calibrated (offset) %f" % (pname, idx, ofs))
pname = 'INS_ACC%sSCAL_%s' % (n, axis)
ofs = util.param_value(conn.test, pname)
if abs(ofs-1.0) < 1.0e-10:
util.failure("%s is zero - accel %u not calibrated (scale)" % (pname, idx))
logger.info("Accel cal %u OK" % (idx+1))
def check_accel_cal(conn):
'''check accel cal'''
for idx in range(NUM_ACCELS):
if idx == 0:
n = ''
else:
n = '%u' % (idx + 1)
for axis in ['X', 'Y', 'Z']:
pname = 'INS_ACC%sOFFS_%s' % (n, axis)
ofs = util.param_value(conn.test, pname)
if abs(ofs) < 1.0e-10:
util.failure(
"%s is zero - accel %u not calibrated (offset) %f" %
(pname, idx, ofs))
pname = 'INS_ACC%sSCAL_%s' % (n, axis)
ofs = util.param_value(conn.test, pname)
if abs(ofs - 1.0) < 1.0e-10:
util.failure("%s is zero - accel %u not calibrated (scale)" %
(pname, idx))
logger.info("Accel cal %u OK" % (idx + 1))
def check_gyro_cal(conn):
'''check gyro cal'''
for idx in range(NUM_GYROS):
if idx == 0:
n = ''
else:
n = '%u' % (idx+1)
for axis in ['X', 'Y', 'Z']:
pname = 'INS_GYR%sOFFS_%s' % (n, axis)
ofs = util.param_value(conn.test, pname)
ofs = float(conn.test.match.group(1))
if abs(ofs) < 0.000001:
util.failure("%s is zero - gyro %u not calibrated (offset)" % (pname, idx))
logger.info("Gyro cal %u OK" % (idx+1))
def check_gyro_cal(conn):
'''check gyro cal'''
for idx in range(NUM_GYROS):
if idx == 0:
n = ''
else:
n = '%u' % (idx + 1)
for axis in ['X', 'Y', 'Z']:
pname = 'INS_GYR%sOFFS_%s' % (n, axis)
ofs = util.param_value(conn.test, pname)
ofs = float(conn.test.match.group(1))
if abs(ofs) < 0.000001:
util.failure("%s is zero - gyro %u not calibrated (offset)" %
(pname, idx))
logger.info("Gyro cal %u OK" % (idx + 1))
