I have problems with my code

I am trying to control 3 servos with arduino/matlab:
(2) MG995
(1) SG90
Creating a Scara robot where the objective will be to play circles and tacks on a square plane of nine sections.
At the moment our goal is to make the pen or pencil where it will go through each section to draw the circle or cross out the centroid of each section to only identify coordinates.
Can anyone help us please?
But when we run the program, our robot does not move at all.
clear bar;
clc;
close all;
I=input('¿A que seccion te gustaria ir?');
grados=1/180;
a=arduino('COM4','Uno','Libraries','Servo');
s1=servo(a,'D3');
writePosition(s1,grados*50);
pause(1);
s2=servo(a,'D5');
writePosition(s2,grados*90);
pause(1);
s3=servo(a,'D6');
writePosition(s3,grados*20);
pause(1);
switch I
case 1
s1=servo(a,'D3');
writePosition(s1,grados*38);
pause(1);
s2=servo(a,'D5');
writePosition(s2,grados*20);
pause(1);
s3=servo(a,'D6');
writePosition(s3,grados*20);
pause(1);
case 2
s1=servo(a,'D3');
writePosition(s1,grados*58);
pause(1);
s2=servo(a,'D5');
writePosition(s2,grados*16);
pause(1);
s3=servo(a,'D6');
writePosition(s3,grados*20);
pause(1);
case 3
s1=servo(a,'D3');
writePosition(s1,grados*100);
pause(1);
s2=servo(a,'D5');
writePosition(s2,grados*23);
pause(1);
s3=servo(a,'D6');
writePosition(s3,grados*20);
pause(1);
case 4
s1=servo(a,'D3');
writePosition(s1,grados*43);
pause(1);
s2=servo(a,'D5');
writePosition(s2,grados*43);
pause(1);
s3=servo(a,'D6');
writePosition(s3,grados*20);
pause(1);
case 5
s1=servo(a,'D3');
writePosition(s1,grados*56);
pause(1);
s2=servo(a,'D5');
writePosition(s2,grados*43);
pause(1);
s3=servo(a,'D6');
writePosition(s3,grados*20);
pause(1);
case 6
s1=servo(a,'D3');
writePosition(s1,grados*75);
pause(1);
s2=servo(a,'D5');
writePosition(s2,grados*47);
pause(1);
s3=servo(a,'D6');
writePosition(s3,grados*20);
pause(1);
case 7
s1=servo(a,'D3');
writePosition(s1,grados*55);
pause(1);
s2=servo(a,'D5');
writePosition(s2,grados*75);
pause(1);
s3=servo(a,'D6');
writePosition(s3,grados*20);
pause(1);
case 8
s1=servo(a,'D3');
writePosition(s1,grados*55);
pause(1);
s2=servo(a,'D5');
writePosition(s2,grados*68);
pause(1);
s3=servo(a,'D6');
writePosition(s3,grados*20);
pause(1);
case 9
s1=servo(a,'D3');
writePosition(s1,grados*82);
pause(1);
s2=servo(a,'D5');
writePosition(s2,grados*81);
pause(1);
s3=servo(a,'D6');
writePosition(s3,grados*20);
pause(1);
otherwise
end

1 件のコメント

darova
darova 2021 年 8 月 8 日
Make your code more readable using arrays
s1a = [38 58 100 43 56 75 55 55 82];
% s2a =
% s3a =
s1=servo(a,'D3');
writePosition(s1,grados*s1a(I));
pause(1);
s2=servo(a,'D5');
writePosition(s2,grados*s2a(I));
pause(1);
s3=servo(a,'D6');
writePosition(s3,grados*s3a(I));
pause(1);

サインインしてコメントする。

回答 (0 件)

カテゴリ

ヘルプ センター および File ExchangeMATLAB Support Package for Arduino Hardware についてさらに検索

質問済み:

2021 年 8 月 7 日

コメント済み:

2021 年 8 月 8 日

Community Treasure Hunt

Find the treasures in MATLAB Central and discover how the community can help you!

Start Hunting!

Translated by