blob: 244da372c1aa2c21a82a8ab5107f36cf0784840a (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
|
model servo_init "Rotate Servo Motor "
extends Modelica.Icons.Example;
import sComm = Arduino.SerialCommunication.Functions;
import strm = Modelica.Utilities.Streams;
Integer ok(fixed = false);
Integer c_ok(fixed = false);
algorithm
when initial() then
ok := sComm.open_serial(1, 2, 115200) "COM port is 2 and baud rate is 115200";
if ok <> 0 then
strm.print("Check the serial port and try again");
else
sComm.delay(2000);
sComm.cmd_servo_attach(1, 1) "To attach the motor to pin 5 of servo1";
sComm.cmd_servo_move(1, 1, 30) "tell servo to rotate by 30 degrees";
sComm.delay(1000);
end if;
c_ok := sComm.close_serial(1) "To close the connection safely";
end when;
sComm.cmd_servo_detach(1, 1);
annotation(
experiment(StartTime = 0, StopTime = 5, Tolerance = 1e-6, Interval = 5));
end servo_init;
|
