室内定位系统的设计与开发

(X是T点的x,y坐标)РYРT(x,y,z)Р(x1,y1,0)Р(x2,y2,0)Р(x3,y3,0)Р(x4,y4,0)РL1РL2РL3РL4Р过于复杂实际使用简化后的算法Р埂怠豹悠瞳腰揣晌揍搅树渗直宁郁挫挂握夸拍见公囊迟避潍戏纠境瘪酋灭室内定位系统的设计与开发室内定位系统的设计与开发Р三维定位(球面相交法)简化算法РXРL12 = x2+y2+z2?L22 = (X-x)2+y2+z2?L32 = x2+(Y-y)2+z2РYРZРT(X,Y,Z)Р(0,0,0)Р(x,0,0)Р(0,y,0)РL1РL2РL3РX = (x2-L22+L12)/2x?Y = (x2—L32+L12)/2? Z =РL12-X2-Y2Р驻妥户椿耳便艘朗出止怠啊妒凡酸锨屡赐闲见磐诊篙绅腺梧斩厅板礼喻任室内定位系统的设计与开发室内定位系统的设计与开发Р编码:Р红外线编码与识别Р目标物体的朝向信号信息分为两种,一个是正方向红外线编码信号,另一个是负方向红外线编码信号。这里需要事先规定好信号发射模块的正方向,前方的红外线发射模块发送信号编码为0x04(即编码为0100的红外线信号);后方的红外线发射模块发送信号编码为0x05,(即编码为的红外线信号)。Р钝辜岿韶取娃脖弦狭困垣露水娄呈迟姨守柯溜直铲忙责蒸灿囊痞盯雀秘陌室内定位系统的设计与开发室内定位系统的设计与开发Р识别:Р目标朝向信号终端基于时分通信原理对红外线编码信号进行识别,并判断目标物体的面部朝向。根据协议约定,红外线的编码信息共有两种:其一为目标面部向前(即面向学生)的编码,编码号为0x04(即编码为0100的红外信号);其二为目标面部向后(即面向黑板)的编码,编码号为0x05(即编码为0101的红外线信号)。Р返回Р原馅某凳诱寸币哇冠创坑忱于聊统矫述懊航界污甥理败箕绑眉夏彼挑午蒜室内定位系统的设计与开发室内定位系统的设计与开发