Sei sulla pagina 1di 1

Function main

Integer index
Pallet 1, 1P6x2, 2P6x2, 3P6x2, 2, 6
Pallet 2, 1P4x3, 2P4x3, 3P4x3, 3, 4

'define pallet 1 for 6 by 2


'define pallet for 4 by 3

InitRobot

'funciton for the 3 initial steps

For index = 1 to 12
Jump Pallet(1, index)
ClampClose 1
Wait 0.5
Jump Pallet(2, index)
ClampOpen 1
Wait 0.5
Next I

'declare points 1 to 12
'move to pallet 1
'close clamp to pick up object
'waits for .5 seconds before next step
'move to pallet 2
'drop object
'waits for .5 second before next step
'next integer

Fend
Function IntRobot
Reset

'resets the robot to its original positi

Motor On
Power Low

'turns motor on
'keeps motor speed low

on
Fend

Potrebbero piacerti anche