Source code for morse.middleware.pocolibs.sensors.platine_posture

import logging; logger = logging.getLogger("morse." + __name__)
from morse.middleware.pocolibs_datastream import *
from platine.struct import *
from math import degrees

[docs]class PlatinePoster(PocolibsDataStreamOutput): _type_name = "PLATINE_STATES" _type_url = "http://trac.laas.fr/git/platine-genom/tree/platineStruct.h#n53"
[docs] def initialize(self): PocolibsDataStreamOutput.initialize(self, PLATINE_STATES) self.obj = PLATINE_STATES()
[docs] def default(self, ci): self.obj.stateRad.pos.pan = self.data['pan'] self.obj.stateRad.pos.tilt = self.data['tilt'] self.obj.stateDeg.pos.pan = degrees(self.data['pan']) self.obj.stateDeg.pos.tilt = degrees(self.data['tilt']) self.write(self.obj)