Math2Var_F32

You are here:
Estimated reading time: 1 min
Go back to the VM operations list

Prototype

Math2Var_F32 (r1, r2, funcId)

Description

Math on two float variables.

r1 = operation(r1, r2);

Return
Nothing

Code Example

The following code example uses the Math2Var_F32 function.

The SMK900.evi file used for this example can be downloaded at the bottom of this page.
/* Example Code
* Math2Var_F32
*
* get buffer indexes r1, r2 and funcId
* set buffer in memory
* operate 
* if params used 
* 	return result of funcId on 32 bits
* else 
* 	return 0x00 (operation not ok) or 0x01 (operation ok) on 8 bits
*
* example VMExecuteCmd:
* cmd: 															   |r1       |r2       |funcId|buffer
*		0xfb 0x0e 0x00 0x0c 0x00 0x0e [0x?? 0x?? 0x?? = macAdress] 0x00 0x00 0x04 0x00 0x04 0x00 0x00 0x90 0x3f 0x00 0x00 0x00 0x3f
* rsp: 	0xfb 0x08 0x00 0x2d 0x00 0xe1 0x1e 0x00 0x00 0x00 0x3e
*/


#include "SMK900.evi"

#define SENSORCODE 0x01
	
function exec_aircmd(){
	local rxLen;
	local useParams;
	local r1,r2,funcId,val0,val1,val2,val3;
	local i;
	local result;

	rxLen=GetAirBuf(0, 0, 20);
	
	if(rxLen>=14){ // 1 byte for paketID + 13 bytes of payload (5 bytes for params and 8 bytes for buffer)
		useParams=true;
		r1=GetBuffer_16(1);
		r2=GetBuffer_16(3);
		funcId=GetBuffer_U8(5);
		for(i=6;i<rxLen;i++){
			SetBuffer(i-6,GetBuffer_S8(i),1);
		}
	}else{
		useParams=false;
		r1=0;
		r2=4;
		funcId=0; 		// add
		val0=0x0000; 	// -0.5
		val1=0xBf00;
		val2=0x0000; 	// 1.5
		val3=0x3FC0;
		SetBuffer_16(0,val0);
		SetBuffer_16(2,val1);
		SetBuffer_16(4,val2);
		SetBuffer_16(6,val3);
	}
	
	Math2Var_F32(r1,r2,funcId);

	if(useParams){
		SetBuffer_16(0,GetBuffer_16(r1));
		SetBuffer_16(2,GetBuffer_16(r1+2));
		Send(4);	
	}else{
		result = 0;
		if(GetBuffer_16(2)==0x3F80&&GetBuffer_16(0)==0x0000){ //add(-0.5,1.5)
			SetBuffer_16(0,val0);SetBuffer_16(2,val1);
			SetBuffer_16(4,val2);SetBuffer_16(6,val3);
			funcId=1;
			Math2Var_F32(0,4,funcId); 	// substract
			if(GetBuffer_16(2)==0xBF80&&GetBuffer_16(0)==0x0000){ //substract(-0.5,1.5)
				SetBuffer_16(0,val0);SetBuffer_16(2,val1);
				SetBuffer_16(4,val2);SetBuffer_16(6,val3);
				funcId=2;
				Math2Var_F32(0,4,funcId); 	// multiply
				if(GetBuffer_16(2)==0xBF40&&GetBuffer_16(0)==0x0000){ //multiply(-0.5,1.5)
					SetBuffer_16(0,val0);SetBuffer_16(2,val1);
					SetBuffer_16(4,val2);SetBuffer_16(6,val3);
					funcId=3;
					Math2Var_F32(0,4,funcId); 	// divide
					if(GetBuffer_16(2)==0xBEAA&&GetBuffer_16(0)==0xAAAB){ //divide(-0.5,1.5)
						SetBuffer_16(0,val2);SetBuffer_16(2,val3);
						SetBuffer_16(4,val0);SetBuffer_16(6,val1);
						funcId=4;
						Math2Var_F32(0,4,funcId); 	// modulo
						if(GetBuffer_16(2)==0x0000&&GetBuffer_16(0)==0x0000){ //modulo(1.5,-0.5)
							SetBuffer_16(0,val0);SetBuffer_16(2,val1);
							SetBuffer_16(4,0x4000);SetBuffer_16(6,0x0000);
							funcId=5;
							Math2Var_F32(0,4,funcId); 	// shiftleft
							if(GetBuffer_16(2)==0x3FC0&&GetBuffer_16(0)==0x0000){ //shiftleft(-0.5,2)
								SetBuffer_16(0,val0);SetBuffer_16(2,val1);
								SetBuffer_16(4,val2);SetBuffer_16(6,val3);
								funcId=6;
								Math2Var_F32(0,4,funcId); 	// atan2
								if(GetBuffer_16(2)==0xBEA4&&GetBuffer_16(0)==0xBC7D){ //atan2(-0.5,1.5)
									result = 1;
									SetBuffer(0,result,1);
									Send(1);
									/*
									SetBuffer(4,result,1);
									Send(5);
									*/
								}
							}
						}
					}
				}
			}
		}
		if(result==0){
			
			SetBuffer(0,result,1);
			SetBuffer(1,funcId,1);
			Send(2);
			/*
			SetBuffer(4,result,1);
			SetBuffer(5,funcId,1);
			Send(6);
			*/
		}
	}
}

function main() 
{
	local execType;
	
	execType = GetExecType();
	if(execType==MESHEXECTYPE_AIRCMD_bm){
		exec_aircmd();
	}
}

Go back to the VM operations list

Attachments

Was this article helpful?
Dislike 0
Views: 69
Go to Top