Форум

Главная→Общение→Форум→Технологии→Помогите накидать код→

Помогите накидать код, Pololu maestro

User

Сообщений: 2 Баллов: 1 Регистрация: 10.02.2014

10.02.2014 15:21:50

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

Спасибо!

Изменено: alex102 - 10.02.2014 15:24:41

alex102 User Сообщений: 2 Баллов: 1 Регистрация: 10.02.2014	#2 13.02.2014 07:27:13 Вот накидал,центр 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