3 Z`@sddlTGdddeZdS))*cs8eZdZfddZedddeddZddZZS) Lab5cstjdddtjddS)NT)worldmap_viewer path_viewerparticle_viewer landmark_test)super__init__SLAMSensorModelis_cube)self) __class__ ./Lab5.pyr sz Lab5.__init__i,r)angle_zcCsxtjdj|}t|jjdj|}tdjdj|}tjd}|j|j|t jd}|j|j||S)zV StateNode() =TM=> PilotToPose(self.destination) =C=> Say('done') statenode1 pilottopose1donesay1 textmsgtrans1completiontrans1) StateNodeset_name set_parent PilotToPose destinationSay TextMsgTrans add_sourcesadd_destinationsCompletionTrans)r rrrrrrrrsetup s  z Lab5.setup) __name__ __module__ __qualname__r Posedegreesrr" __classcell__rr)r rrs rN) cozmo_fsmStateMachineProgramrrrrrs