perm filename CALIB.PAL[U,VDS] blob sn#299155 filedate 1977-08-07 generic text, type C, neo UTF8
COMMENT āŠ—   VALID 00004 PAGES
C REC  PAGE   DESCRIPTION
C00001 00001
C00002 00002	.TITLE CALIB
C00003 00003	CONVERSION FACTORS FOR ADC'S AND DAC'S
C00004 00004	KINEMATIC ARM CONSTANTS
C00007 ENDMK
CāŠ—;
.TITLE CALIB

;CALIBRATION DATA FOR THE NRL/SCHEINMAN ARM

HELLO:	.ASCIZ	/
ARM CONTROL PROGRAM, VERSION C, 28JULY77
INITIALIZE(Y,N) = /
	.EVEN

;ADC AND DAC CHANNELS FOR ARM JOINTS

CALIB:
ACHAN:	0			;ADC CHANNELS, JTS 1-7
	1
	2
	3
	4
	5
	6

DCHAN:	00000			;DAC CHANNELS, JTS 1-7
	20000
	40000
	60000
	100000
	120000
	140000
;CONVERSION FACTORS FOR ADC'S AND DAC'S

SCALE:	.WORD	16179.	;SCALE FACTOR FROM ADC TO ANGLES
	.WORD	15941.
	.WORD	-16001.
	.WORD	15731.
	.WORD	11575.
	.WORD	-15778.
	.WORD	2918.

OFFSET:	.WORD	-14022.	;JOINT OFFSETS
	.WORD	-24416.
	.WORD	24306.
	.WORD	-23919.
	.WORD	-11781.
	.WORD	12838.
	.WORD	-2181.

BSCALE:	.WORD	16501.	;S.F. FROM JT. ANG. TO DAC UNITS
	.WORD	41130	;CHANGED BACK BY VICTOR 4/5/77
	.WORD	-16852.
	.WORD	41227 
	.WORD	23088.
	.WORD	-17039.
	.WORD	22846.

BOFFST:	.WORD	2208.	;DAC OFFSET
	.WORD	-8417.
	.WORD	8262.
	.WORD	160062
	.WORD	-175.
	.WORD	-2982. 
	.WORD	750.
;KINEMATIC ARM CONSTANTS

BASEX:	.WORD	0		;X & Y COORDINATE OF BASE
BASEY:	.WORD	0
S1:	.WORD	25424 		;10.77	OFFSET OF LINK 1
A2:	.WORD	20000 		;8.0	LENGTH OF LINK 2
S2S3:	.WORD	11256 		;4.67	OFFSET OF LINK 2 + OFFSET OF LINK 3
S2S3S:	.WORD	534		;21.81	(S2+S3)**2, DOUBLE PREC
	.WORD	167104
S4:	.WORD	20000		;8.0	OFFSET OF LINK 4
S6:  	.WORD	14000		;6.00	OFFSET OF LINK 6
S6S:	.WORD	60000 		;24.0	4*S6
S4A2S:	.WORD	4000		;128.0	S4**2 + A2**2
	.WORD	0
A2DS4:	.WORD	40000		;1.0	A2/S4
A224:	.WORD	10000		;256.0	4*A2ā†‘2
	.WORD	0


;JOINT STOP LIMITS

LSTOP:	.WORD	 -12288.;-135 LOWER JOINT STOP LIMIT
	.WORD	 -22300.;-245
	.WORD	 -5006.	;-55
	.WORD	 -21390.;-235
	.WORD	 -9739.	;-107
	.WORD	 -15474.;-170
LHAND:	.WORD	 -31.	;-.03

USTOP:	.WORD 	 16839.	;185  UPPER JOINT STOP LIMIT
	.WORD	  5461.	;60
	.WORD	 19570.	;215
	.WORD	  5461.	;60
	.WORD	  9739.	;107
	.WORD	 10012. ;110
UHAND:	.WORD	  1946.	;1.9

MIDANG:	.WORD	  2276.	;25   MID POINT BETWEEN UPPER AND LOWER
	.WORD	 -7737.	;-85
	.WORD	  6827.	;75
	.WORD	 -7737.	;-85
	.WORD	     0.	;0
	.WORD	 -2731.	;-30
	.WORD	     0. ;0


;AVERAGE JOINT SPEEDS, USED FOR DETERMINING THE TIME REQUIRED
;TO EXECUTE A MOTION.

SPEEDS:	1500.	; 96 DEG/SEC
	1500.	; 96 DEG/SEC
	1500.	; 96 DEG/SEC
	500.	;288 DEG/SEC
	500.	;288 DEG/SEC
	300.	;480 DEG/SEC

EXTIME:	30.	;A LITTLE EXTRA TIME FOR SHORT MOTIONS

PULTME:	20.	;DURATION OF HAND PULSE MODE

SWAIT==	2	;START WAIT COUNT