Hi All,
My first post , but admittedly a novice feeling on this one , so hoping your able to defragment my mind ,
Process is a vertical linear stroke mounted onto BASE_DATA[1].
I'm want to align the TCP of the hole to the BASE so that the bore of the hole is in alignment essentially. I'm sent the values of a hole ( X/Y/Z/A/B/C ) relative to the flange ( via CAD / CATIA )
The Robot is Ceiling mounted.
The working direction of the tool is "X".
The TOOL_DATA / BASE_DATA are as follows:
TOOL_DATA[3] = {X 36.0810,Y -0.00200000,Z 124.750,A -4.02600,B 89.4660,C -5.50200}
BASE_DATA[1] = {X -211.718506,Y -246.207,Z -1222.30701,A -0.502900,B 0.140900,C -0.129100}
The .SRC is written is KRL , so any help is massively welcomed.
Additional info , the KSS is V8.3.39
robot Type is : KR6-700-2
Rough .SRC as follows:
DEF basepositioningdemo(FI_nToolNr : IN)
;************************************************
;* Description: BasePositioningDemo *
;************************************************
((((Note I have delected folds for initialisations etc.....))))
$TOOL = TOOL_DATA[FI_nToolNr] ; CAD/CATIA Imported X/Y/Z/A/B/C
$ACT_TOOL = FI_nToolN
$BASE = BASE_DATA[1]
$ACT_BASE = 1
IF CALCULATIONS () THEN
MsgQuit("Confirm Your Ready") ;Capture Slow Reaction *TEMP*
PTP XSample1 ; Adjust Via OverView Screen For Testing
ELSE
MsgQuit ("Confirm Your Mistake!!!!") ;Capture Slow Reaction *TEMP*
ENDIF
; Drive to Xhome
END
-----------------------------------------------------------------------------------------------------------
DEFFCT BOOL CALCULATIONS ()
;FOLD HEADER
;ENDFOLD (Header)
;FOLD DECLARATIONS
DECL BOOL _bResult , _bDataValid[6]
;ENDFOLD (Declarations)
;FOLD EXECUTABLE
$VEL.CP = 0.01
; _bResult = _bDataValid
_bResult = TRUE ; No Data Checking During
RETURN _bResult
;ENDFOLD (Executable)
ENDFCT
----------------------------------------------------------------------------------------------------------
Many thanks inadvance Forum.....