Inverted-Pendulum/setup.adb at Development · oysteinlondal/Inverted-Pendulum · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
package body Setup is

    protected body Motor_Setup is
        procedure Calibrate_Motors_If_Required is
        begin
            if not Setup_Done then
                --Calibrating left and right ESC
                Put("Start Setup");
                delay 4.0;
                --Write(3,1000);
                --Set_Analog_Period_Us(20000);
                --Write(28,1000);
                --Set_Analog_Period_Us(20000);
                --NRF52_DK.Time.Delay_Ms(2000);
                --Write(3,2000);
                --Set_Analog_Period_Us(20000);
                --Write(28,2000);
                --Set_Analog_Period_Us(20000);
                --NRF52_DK.Time.Delay_Ms (2000);
                Setup_Done := True;
            end if;
        end Calibrate_Motors_If_Required;
    end Motor_Setup;

end Setup;