go_sb1stop pshx ;(storage bin1 (SB stand for storage bin)) ldx #sb1stop bra robot_sb1 go_Up1 pshx ldx #UP1 bra robot_sb1 go_Down2 pshx ldx #down1 bra robot_sb1 robot_sb1 ldd 0,x std On_cnts_sb1 ldd 2,x std Off_cnts_sb1 pulx rts go_sb2stop pshx ;(storage bin2 (SB2 stand for storage bin2)) ldx #sb2stop bra robot_sb2 go_Up2 pshx ldx #UP2 bra robot_sb2 go_Down2 pshx ldx #down2 bra robot_sb2 robot_sb2 ldd 0,x std On_cnts_sb2 ldd 2,x std Off_cnts_sb2 pulx rts go_sb3stop pshx ;(storage bin3 (SB3 stand for storage bin2)) ldx #sb3stop bra robot_sb3 go_Up3 pshx ldx #UP3 bra robot_sb3 go_Down3 pshx ldx #down3 bra robot_sb3 robot_sb3 ldd 0,x std On_cnts_sb3 ldd 2,x std Off_cnts_sb3 pulx rts ;Table for storage bin1 Functions ; On_cnts_sb1 Off_cnts_sb1 UP1 fdb 2000, 18000 DOWN1 fdb 4500, 14800 sb1stop fdb 3000, 17000 fdb 3000, 17000 ;Table for storage bin2 motor Functions ; On_cnts_sb2 Off_cnts_sb2 UP2 fdb 2000, 18000 DOWN2 fdb 4500, 14800 sb2stop fdb 3000, 17000 ;Table for storage bin3 motor Functions ; On_cnts_sb3 Off_cnts_sb3 UP3 fdb 2000, 18000 DOWN3 fdb 4500, 14800 sb3stop fdb 3000, 17000