This simple program uses two servos to control a simple claw where the servo on pin a1 move the claw uyp and down and the servo on a2 opens and closes the claw.
A set of 5 RGB smart LEDs is connected to pin a3 and randomly change color.
Program
---
Servo Arm Test Program
---
prog_vars =
d/count 0
d/arm_pos 0
d/claw_pos 0
d/total_leds 5
d/led_no 0
d/red 0
d/green 0
d/blue 0
prog_vars.
prog_start =
"Robot Arm Program"
svp a1 0
svp a2 20
sled a3 /total_leds 0 /red /green /blue
prog_start.
prog_loop =
change_led_colors
repeat 1 ->
svt a1 0 90 10
svt a2 0 100 10
d50
repeat.
change_led_colors
repeat 1 ->
svt a1 1 90 10
svt a2 0 100 10
d50
repeat.
change_led_colors
prog_loop.
change_led_colors =
repeat 25 ->
-- Set each color to a random value
rand 0 255 -> /red
rand 0 255 -> /green
rand 0 255 -> /blue
sled a3 /total_leds /led_no /red /green /blue
dly 25
-- Inc to the next LED and then start again.
any /led_no >= 6 ->
/led_no 0
else
inc /led_no
enda.
repeat.
change_led_colors.
prog_stop =
"Bye"
prog_stop.