49994 (Основные особенности робототехнических систем), страница 3

После этого в соответствии с планом сборочной операции второй процесс запускает исполнение движения, обеспечивающего установку NKD2. Это движение заключается в том, что торец стержня слегка прижимается к горизонтальной плоскости детали и осуществляются небольшие колебания стержня во всех направлениях в этой плоскости. Вначале за счет податливости захвата стержень находится в постоянном контакте с горизонтальной плоскостью детали. Но с момента зацепления стержня за край отверстия он начинает проваливаться в отверстие за счет поджатия, а также за продолжающихся колебаний. При этом внутренняя поверхность отверстия служит направляющей для стержня.

В то время как в первом процессе осуществляется движение установки, во втором процессе происходит проверка условия NC2, приписанного данному движению. В цикле проверяется, произошли ли некоторые события, связанные с попаданием стержня в отверстие. Как только стержень попадает в отверстие, захват манипулятора опустится в вертикальном направлении на длину стержня, вставляемого в отверстие. Кроме того, реальная амплитуда колебаний захвата манипулятора резко уменьшится (так как находящийся в отверстии стержень будет тормозить его движение). Эти события можно установить по показаниям потенциометрических датчиков положения звеньев манипулятора. Если указанные события не наступили, то проверка повторяется, если же события совершились, то движение установки считается законченным, проверка условия прекращается и вырабатывается код ответа 0.

В этом цикле проверяется также время, затрачиваемое на установку стержня. Представляется естественным ожидать наступления событий, связанных с попаданием стержня в отверстие, не сколь угодно долго, а по истечении заданного интервала времени. Если за указанное время стержень не попал в отверстие (например, вследствие заклинивания), то движение NKD2 считается не удавшимся, проверка условия прекращается и вырабатывается код ответа

После прекращения движения NKD2 второй процесс запускает или движение NKD3 повторного подвода стержня к отверстию, или движение NKD4 разжатия захвата. Вершина 4 в плане сборочной операции является конечной (рис. 4).

При завершении исполнения сборочной операции NO1 интерпретатор во втором процессе пытается выбрать из плана сборки очередную операцию, убеждается, что ее нет, и заканчивает сборку.

Непрерывно происходит или интерпретация плана сборки и планов сборочных операций, или проверка условий, приписанных движениям. Эти действия заканчиваются только тогда, когда кончается сборка.