Proportionnal Digital decoding 4 channels for RC systems with 14M2.

jojojo

Senior Member
Just to be used in conjunction whith his brother. (see upper).

Here it is :

Code:
'****************************************************************************
'*			Décodeur proportionnel-digital					    *
'*			pour radiocommande 4 voies					    *
'*			PICAXE 14M2								    *
'*			G.TREELS   01/2014						    *
'****************************************************************************


#picaxe 14M2
SetFreq M32

Do

Do
Pulsin C.3,0,w0
Loop while w0<4000

Pulsin C.3,1,w1
Pulsin C.3,1,w2
Pulsin C.3,1,w3
Pulsin C.3,1,w4
If w1<640 Then	'compensation et sécurité
	w1=640	'640 =>0.8ms
End if		'
If w1>1760 Then	'
	w1=1760	'1760 =>2.2ms
End if		'
w1=w1*5/4

Pulsout B.1,w1
If w2<640 Then
	w2=640
End if
If w2>1760 Then
	w2=1760
End if
w2=w2*5/4

Pulsout B.2,w2
If w3<640 Then
	w3=640
End if
If w3>1760 Then
	w3=1760
End if
w3=w3*5/4

Pulsout B.3,w3
If w4<640 Then
	w4=640
End if
If w4>1760 Then
	w4=1760
End if
w4=w4*5/4

Pulsout B.4,w4

Loop
Cheers.
 
Top