+7-960-0655211 (Билайн)
+7-987-4207734 (МТС)
интернет-магазин
доставка по России и СНГ
нам уже 10 лет!

Форум

Страницы: 1
Помогите накидать код, Pololu maestro
 
Здравствуйте! Есть контроллер http://www.pololu.com/product/1350/
Собрал узел автоматического управления лазером для 3д сканера,который состоит из поворотной платформы,в движение ее приводит серва 360 гр. и стоит внешний потенциометр (связан с осью платформы).
Необходимо написать скрипт:
-при запуске системы, чтобы платформа устанавливалась в горизонт (нивелирование сервы)
- далее отклонялась вверх и вниз в зависимости от показаний потенциометра (диапазон потенциометра 0-255, горизонт допустим 120, граничные значения отклонений по данным потенциометра 70-120-170)

Спасибо!
Изменено: alex102 - 10.02.2014 15:24:41
 
Вот накидал,центр 90, при включении ловит диапазон патенциометра 85-95, далее начинает цикл от 73 до 170.


begin
1 get_position
90 less_than
if
0 0 6900 0 0 0 frame_0
else
0 0 5200 0 0 0 frame_0
endif

1 get_position
95 less_than
if
1 get_position
85 greater_than
if
0 0 6000 0 0 0 frame_0
10
begin
dup
while
gogo
1 minus
repeat
0 0 6000 0 0 0 frame_0
QUIT
endif
endif
repeat


sub frame_0
5 servo
4 servo
3 servo
2 servo
0 servo
delay
return

sub gogo
forward:
begin
0 0 6300 0 0 0 frame_0
1 get_position
170 greater_than
if
0 0 6000 0 0 0 frame_0
goto back
endif
repeat
back:
begin
0 0 5800 0 0 0 frame_0
1 get_position
73 less_than
if
0 0 6000 0 0 0 frame_0
return
endif
repeat

return
Страницы: 1
Читают тему (гостей: 1)