Skip to content
Snippets Groups Projects
Commit c463c17a authored by Tamas Gal's avatar Tamas Gal :speech_balloon:
Browse files

Use CLBMap to retrieve CLB info

parent 3fc1dd1b
No related branches found
No related tags found
No related merge requests found
...@@ -46,7 +46,7 @@ class CalibrateAHRS(kp.Module): ...@@ -46,7 +46,7 @@ class CalibrateAHRS(kp.Module):
self.detector = kp.hardware.Detector(det_id=det_id) self.detector = kp.hardware.Detector(det_id=det_id)
self.du = self.get('du', default=1) self.du = self.get('du', default=1)
self.db = kp.db.DBManager() self.clbmap = kp.db.CLBMap(det_oid=det_id)
self.cuckoo = kp.time.Cuckoo(60, self.create_plot) self.cuckoo = kp.time.Cuckoo(60, self.create_plot)
self.cuckoo_log = kp.time.Cuckoo(10, print) self.cuckoo_log = kp.time.Cuckoo(10, print)
...@@ -66,29 +66,28 @@ class CalibrateAHRS(kp.Module): ...@@ -66,29 +66,28 @@ class CalibrateAHRS(kp.Module):
now = datetime.utcnow() now = datetime.utcnow()
tmch_data = TMCHData(io.BytesIO(blob['CHData'])) tmch_data = TMCHData(io.BytesIO(blob['CHData']))
dom_id = tmch_data.dom_id dom_id = tmch_data.dom_id
try: clb = self.clbmap.dom_id[dom_id]
du, floor, _ = self.detector.doms[dom_id] if clb.floor == 0:
except KeyError: # base CLB self.log.info("Skipping base CLB")
return blob return blob
if du != self.du: if clb.du != self.du:
return blob return blob
clb_upi = self.db.doms.via_dom_id(dom_id, self.detector.det_id).clb_upi
yaw = tmch_data.yaw yaw = tmch_data.yaw
calib = get_latest_ahrs_calibration(clb_upi, max_version=4) calib = get_latest_ahrs_calibration(clb.upi, max_version=4)
if calib is None: if calib is None:
return blob return blob
cyaw, cpitch, croll = fit_ahrs(tmch_data.A, tmch_data.H, *calib) cyaw, cpitch, croll = fit_ahrs(tmch_data.A, tmch_data.H, *calib)
self.cuckoo_log("DU{}-DOM{} (random pick): calibrated yaw={}".format( self.cuckoo_log("DU{}-DOM{} (random pick): calibrated yaw={}".format(
du, floor, cyaw)) clb.du, clb.floor, cyaw))
with self.lock: with self.lock:
self.data['yaw'][floor].append(cyaw) self.data['yaw'][clb.floor].append(cyaw)
self.data['pitch'][floor].append(cpitch) self.data['pitch'][clb.floor].append(cpitch)
self.data['roll'][floor].append(croll) self.data['roll'][clb.floor].append(croll)
self.times[floor].append(now) self.times[clb.floor].append(now)
self.cuckoo.msg() self.cuckoo.msg()
return blob return blob
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment