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)