Ejemplo n.º 1
0
int main(int argc, char **argv)
{
    struct sigaction sa;
    struct tonegend tonegend;
    struct cmdopt cmdopt;

    cmdopt.daemon = 0;
    cmdopt.uid = -1;
    cmdopt.path = NULL;
    cmdopt.standard = STD_CEPT;
    cmdopt.interactive = 0;
    cmdopt.sample_rate = 48000;
    cmdopt.statistics = 0;
    cmdopt.buflen = 0;
    cmdopt.minreq = 0;
    cmdopt.dtmf_tags = NULL;
    cmdopt.ind_tags = NULL;
    cmdopt.notif_tags = NULL;
    cmdopt.dtmf_volume = 100;
    cmdopt.ind_volume = 100;
    cmdopt.notif_volume = 100;
    
    parse_options(argc, argv, &cmdopt);

    memset(&tonegend, 0, sizeof(tonegend));

    memset(&sa, 0, sizeof(sa));
    sa.sa_sigaction = signal_handler;
    sa.sa_flags = SA_SIGINFO;
    
    if (sigaction(SIGHUP , &sa, NULL) < 0 ||
        sigaction(SIGTERM, &sa, NULL) < 0 ||
        sigaction(SIGINT , &sa, NULL) < 0   ) {
        LOG_ERROR("Failed to install signal handlers");
        return errno;
    }

    if (dbusif_init(argc, argv)    < 0 ||
        ausrv_init(argc, argv)     < 0 ||
        stream_init(argc, argv)    < 0 ||
        tone_init(argc, argv)      < 0 ||
        envelop_init(argc, argv)   < 0 ||
        indicator_init(argc, argv) < 0 ||
        dtmf_init(argc, argv)      < 0 ||
        note_init(argc, argv)      < 0 ||
        interact_init(argc, argv)  < 0 ||
        rfc4733_init(argc, argv)   < 0 ||
        notif_init(argc, argv)     < 0) {
        LOG_ERROR("Error during initialization");
        return EINVAL;
    }


    stream_set_default_samplerate(cmdopt.sample_rate);
    stream_print_statistics(cmdopt.statistics);
    stream_buffering_parameters(cmdopt.buflen, cmdopt.minreq);

    dtmf_set_properties(cmdopt.dtmf_tags);
    indicator_set_properties(cmdopt.ind_tags);
    notif_set_properties(cmdopt.notif_tags);

    dtmf_set_volume(cmdopt.dtmf_volume);
    indicator_set_volume(cmdopt.ind_volume);
    notif_set_volume(cmdopt.notif_volume);

    if (cmdopt.daemon)
        daemonize(cmdopt.uid, cmdopt.path);

    if ((main_loop = g_main_loop_new(NULL, FALSE)) == NULL) {
        LOG_ERROR("Can't create main loop");
        return EIO;
    }
        
    if ((tonegend.dbus_ctx = dbusif_create(&tonegend)) == NULL) {
        LOG_ERROR("D-Bus setup failed");
        return EIO;
    }

    if ((tonegend.ausrv_ctx = ausrv_create(&tonegend,pa_server_name)) == NULL){
        LOG_ERROR("Pulse Audio setup failed");
        return EIO;
    }

    if (rfc4733_create(&tonegend) < 0) {
        LOG_ERROR("Can't setup rfc4733 interface on D-Bus");
        return EIO;
    }

    if (notif_create(&tonegend) < 0) {
        LOG_ERROR("Can't setup notification interface on D-Bus");
        return EIO;
    }

    if (!cmdopt.daemon && cmdopt.interactive) {
        if (!(tonegend.intact_ctx = interact_create(&tonegend,fileno(stdin)))){
            LOG_ERROR("Can't setup interactive console");
            return EIO;
        }
        printf("Running in interactive mode\n");
    }

    indicator_set_standard(cmdopt.standard);

    g_main_loop_run(main_loop);

    LOG_INFO("Exiting now ...");

    ausrv_destroy(tonegend.ausrv_ctx);
    dbusif_destroy(tonegend.dbus_ctx);
    interact_destroy(tonegend.intact_ctx);

    if (main_loop != NULL) 
        g_main_loop_unref(main_loop);

    ausrv_exit();

    return 0;
}
Ejemplo n.º 2
0
void main(void)
{
    // настройка таймера
    init_timer0();
    // настройка LCD
    InitLcd();
    // настройка индикации
    indicator_init();
    // глобальная настройка портов входных/выходных развязок
    {
        // выходная развязка - выход, на выход=1
        DDRF = 255;
        PORTF = 255;
        DDRE |= 1<<2;
        DDRE |= 1<<3;
        PORTE |= 1<<2;
        PORTE |= 1<<3;
        // верхняя входная развязка, вход
        DDRD &= ~(1<<5);
        DDRD &= ~(1<<4);
        DDRB &= ~(1<<7);
        DDRB &= ~(1<<6);
        DDRB &= ~(1<<5);
        DDRB &= ~(1<<4);
        DDRE &= ~(1<<7);
        DDRE &= ~(1<<6);
        DDRE &= ~(1<<5);
        DDRE &= ~(1<<4);
        PORTD |= 1<<5;
        PORTD |= 1<<4;
        PORTB |= 1<<7;
        PORTB |= 1<<6;
        PORTB |= 1<<5;
        PORTB |= 1<<4;
        PORTE |= 1<<7;
        PORTE |= 1<<6;
        PORTE |= 1<<5;
        PORTE |= 1<<4;
        // нижняя входная развязка, вход
        DDRC = 0;
        DDRD &= ~(1<<7);
        DDRD &= ~(1<<6);
        PORTC = 255;
        PORTD |= 1<<7;
        PORTD |= 1<<6;
    }
    // зануление сбора дефектов на линии реза
    {
        unsigned char i;
        for (i=0; i<16; i++)
            def_rez_m[i]=0;
    }
    // зануление сопровождения на станке
    rez_init();
    def_rez=0;
    // зануление работы упора и сопровождения по датчикам
    upor_init();
    // разрешение прерываний
    _SEI();
    //------------
    {
        extern unsigned int timeout_key;
        unsigned char err;
        ClearDisplay1();
        Show_m2( 0,"Т2,стан№1");
        Show_m2(16,"29.01.2013");
        for (timeout_key=5000;;)
        {
            if ( timeout_key<5 )
                break;
        }
        err=PING & 0x08;
        // стереть память
        if ( err==0 )
            ep_zero();
    }

    //--------------
    // настройка цифрового фильтра датчиков дефектов
    defect_init();
    // начальная настройка kk
    pulsar_init();
    //-------------
    ClearDisplay1();
#ifdef RSPC
    rspc_init();
#endif
    // сброс кол-ва циклов сработки колеса
    koleso_cicle=0;
    for(;;)
    {
        //
        OutPC_FromMainCycle();
        // выбор экрана
        // indicator_next();
        // индикация
        indicator_cicle();
        //==========================
        if ( koleso_cicle>2 )
        {
            DDRF |= (1<<6);
            PORTF &= ~(1<<6);
        }
        //=========================================
        // Сигнал рез, разделение на трубы
        if ( rez_fg==255 )
        {
            // сброс флага рез
            rez_fg=0;
            // новая труба, длина=1, сброс дефектов
            rez_ms_def[0]=0;
            rez_ms_ind[0]=1;
            // перенос дефекта и трубы в следущую позитцию
            // 1-4 - сопровождение на станке от 1 до 4 труб
            // 1 - еще неотрезаная труба
            // перенос дефекта
            rez_ms_def[4]=rez_ms_def[3];
            rez_ms_def[3]=rez_ms_def[2];
            rez_ms_def[2]=rez_ms_def[1];
            rez_ms_def[1]=rez_ms_def[0];
            // перенос длины от линии реза
            rez_ms_ind[4]=rez_ms_ind[3];
            rez_ms_ind[3]=rez_ms_ind[2];
            rez_ms_ind[2]=rez_ms_ind[1];
            rez_ms_ind[1]=rez_ms_ind[0];
            rez_ms_ind[1]=1;
            // длина отрезаной трубы
            tube_len=rez_ms_ind[2];
            // сброс флага дефекта очередной трубы
            def_rez_out=0;
            // подсчет труб дефектных и общее количество
            tube_count++;
            {
                unsigned char maska;
                maska = ((1<<0) | (1<<1) | (1<<3));
                if ( (rez_ms_def[2] & maska)>0 )
                    tube_count_def++;
            }
        }



        // сработало колесо
        if ( koleso_cicle>0 )
        {
            //=========================================
            {
                // анализ сигнала с кельвина и укладка маркировки ограниченой длины
                void kelv_analiz(void);
                kelv_analiz();
            }
            //=========================================

            // протяжка дефектов
            {
                unsigned int i;
                for ( i=1; i<8; i++)
                {
                    if ( ind_def8[i]>0 )
                    {
                        ind_def8[i]=0;
                        ind_def12[ d_def_sm[i]/ind_def_k ]=ind_def_k;
                    }
                }


                // отображение на 12
                if ( ind_def12[0]>0 ) ind_def12[0]--;
                for (i=1; i<12; i++)
                {
                    if ( ind_def12[i]>0 ) ind_def12[i]--;
                    if ( d_def[indx_norm(i*ind_def_k)]>0 )  ind_def12[i-1]=ind_def_k;
                }
                //===============================================
                d_def[indx_norm(0)]=0;
                indx_inc();
            }

//=========================================
            // сопровождение от краско отметчиков до линии реза
            {
                unsigned char i;
                for (i=152; i>0; i--) s_def[i]=s_def[i-1];
                s_def[0]=d_def[indx_norm(1)];
            }
            //----------------------------
            // индикация дефекта от кк до реза
            if ( ind_d_korez>0 ) ind_d_korez--;
            if ( s_def[0]>0 ) ind_d_korez=d_rez_sm;
//=========================================
            // "пятно" дефектов в р-не линии реза
            /*
            {
              unsigned char i;
              //
              for (i=0;i<10;i++)
              {
                // def_rez_m[i]=def_rez_m[i-1];
                // 105 -5 = 100
                // def_rez |= s_def[i+100];
                def_rez |= s_def[i+d_rez_sm-5];
                // def_rez |= def_rez_m[i];
              }
              // def_rez_m[1]=s_def[105-5];
            }
            */
            def_rez |= s_def[d_rez_sm];
            // ShowDigitZ(13,3,s_def[110]);
//==========================================

            // сопровождение на станке до 4 труб
            {
                unsigned char i;
                for (i=1; i<5; i++)
                {
                    if ( rez_ms_ind[i]>0 )rez_ms_ind[i]++;
                    if ( rez_ms_ind[i]>=rez_end )
                    {
                        // конец станка
                        def_rez_out|=rez_ms_def[i];
                        // сброс сопровождения на станке
                        rez_ms_ind[i]=0;
                        rez_ms_def[i]=0;
                    }
                }
            }
//==============================================
            // 1 - накопление дефекта на неотрезаной трубе
            rez_ms_def[1]|=def_rez;
            // сброс флага дефектов
            def_rez=0;
//================================================
// сигнализация работы датчиков
            sign_flag=0;
            if ( sign_count_d1<sign_dl ) sign_count_d1++;
            else sign_flag|=(1<<0);
            if ( sign_count_d2<sign_dl ) sign_count_d2++;
            else sign_flag|=(1<<1);
            if ( sign_count_d3<sign_dl ) sign_count_d3++;
            else sign_flag|=(1<<2);
            if ( sign_count_d4<sign_dl ) sign_count_d4++;
            else sign_flag|=(1<<3);
            if ( sign_count_d5<sign_dl ) sign_count_d5++;
            else sign_flag|=(1<<4);
            if ( sign_flag>0 )
            {
                DDRF |= (1<<4);
                PORTF &= ~(1<<4);
            }
            else
            {
                DDRF |= (1<<4);
                PORTF |=  (1<<4);
            }
//==============================================
            // Работа с краскопультом
            pulsar_cicle();
            // конец цикла колесо
            koleso_cicle--;
        }
// ===== конец работы "внутри срабатывания колеса" =======
//--------------------
        // сопровождение по датчикам
        // датчик 1 ( фрсу )
        if ( trub_fg_1==255 )
        {
            trub_fg_1=128;
            // чтение дефекта
            defect1=def_rez_out;
            defect1r=defect1;
            // сброс флага дефекта очередной трубы
            // def_rez_out=0;
            // запуск краскоотметчика на толщиномер
            pusk_kr3( defect1r );
        }
        if ( trub_fg_1==0 )
        {
            trub_fg_1=128;
            defect1=0;
        }
//----------------------------------------
        // датчик 2
        if ( trub_fg_2==255 )
        {
            trub_fg_2=128;
            defect2=defect1r;
            defect2r=defect2;
        }
        if ( trub_fg_2==0 )
        {
            trub_fg_2=128;
            defect2=0;
        }
//---------------------------------------
        // датчик 3
        if ( trub_fg_3==255 )
        {
            trub_fg_3=128;
            if ( (sign_flag & (1<<1) ) == 0 )
            {
                defect3=defect2r;
                defect3r=defect3;
            }
            else
            {
                defect3=defect1r;
                defect3r=defect3;
            }
        }
        if ( trub_fg_3==0 )
        {
            trub_fg_3=128;
            defect3=0;
        }
//----------------------------------------
        // датчик 4
        if ( trub_fg_4==255 )
        {
            trub_fg_4=128;
            defect4=defect3r;
            defect4r=defect4;
        }
        if ( trub_fg_4==0 )
        {
            trub_fg_4=128;
            defect4=0;
        }
//----------------------------------------------
        {
            unsigned char mask_d;
            mask_d = ((1<<0) | (1<<1) | (1<<2) | (1<<3));
            // датчик 5
            if ( trub_fg_5==255 )
            {
                trub_fg_5=128;
                defect5=defect4r;
                // упор верх
                if ( (defect5 & mask_d)>0 )
                {
                    upor_up();
                    upor_flag=255;
                }
            }
            if ( trub_fg_5==0 )
            {
                trub_fg_5=128;
                // упор вниз
                if ( (defect5 & mask_d)>0 )
                {
                    upor_dn();
                    upor_flag=0;
                }
                defect5=0;
            }
        }
//===============================================
// Сигнализация
        if ( trub_fg_1i != 128 )
        {
            trub_fg_1i=128;
            sign_count_d1=0;
        }
        if ( trub_fg_2i != 128 )
        {
            trub_fg_2i=128;
            sign_count_d2=0;
        }
        if ( trub_fg_3i != 128 )
        {
            trub_fg_3i=128;
            sign_count_d3=0;
        }
        if ( trub_fg_4i != 128 )
        {
            trub_fg_4i=128;
            sign_count_d4=0;
        }
        if ( trub_fg_5i != 128 )
        {
            trub_fg_5i=128;
            sign_count_d5=0;
        }
//===============================================
    }
}
Ejemplo n.º 3
0
void create_indicator ()
{
	indicator_init ();
	menu_init ();
}