本發(fā)明涉及醫(yī)療器械,尤其涉及一種基于mcu與fpga的步進(jìn)電機(jī)報(bào)警控制方法。
背景技術(shù):
1、目前,在醫(yī)療器械檢測領(lǐng)域,隨著檢測速度大幅度提升,要求運(yùn)動機(jī)構(gòu)在多維度運(yùn)動中又快又精確,所以大部分的運(yùn)動部件都會增加行程開關(guān),作為運(yùn)動的終點(diǎn)判斷。
2、但是,行程開關(guān)的信號受到線纜、行程開關(guān)損壞等外部干擾而誤觸發(fā),導(dǎo)致系統(tǒng)認(rèn)為運(yùn)動機(jī)構(gòu)運(yùn)動到終點(diǎn),從而進(jìn)行下一步運(yùn)動,導(dǎo)致運(yùn)動機(jī)構(gòu)撞機(jī)損壞設(shè)備。
技術(shù)實(shí)現(xiàn)思路
1、本發(fā)明的目的在于提供一種基于mcu與fpga的步進(jìn)電機(jī)報(bào)警控制方法,解決了現(xiàn)有的醫(yī)療器械檢測設(shè)備的行程開關(guān)的信號受到等外部干擾而誤觸發(fā),導(dǎo)致運(yùn)動機(jī)構(gòu)撞機(jī)損壞設(shè)備的問題。
2、為實(shí)現(xiàn)上述目的,本發(fā)明提供了一種基于mcu與fpga的步進(jìn)電機(jī)報(bào)警控制方法,包括以下步驟:
3、運(yùn)動機(jī)構(gòu)在運(yùn)動后,對行程開關(guān)的狀態(tài)進(jìn)行檢測,判斷行程開關(guān)是否失效,并上報(bào)錯誤;
4、運(yùn)動機(jī)構(gòu)運(yùn)行一段距離之后,計(jì)算出運(yùn)動機(jī)構(gòu)運(yùn)行的距離,判斷行程開關(guān)是否失效,并上報(bào)錯誤;
5、運(yùn)動機(jī)構(gòu)在運(yùn)動回行程開關(guān)過程中,檢測行程開關(guān)信號,判斷行程開關(guān)是否失效,并上報(bào)錯誤。
6、其中,運(yùn)動機(jī)構(gòu)在運(yùn)動后,對行程開關(guān)的狀態(tài)進(jìn)行檢測,判斷行程開關(guān)是否失效,并上報(bào)錯誤,所述步驟還包括:
7、運(yùn)動機(jī)構(gòu)離開行程開關(guān)時,判斷行程開關(guān)信號狀態(tài)變化,若是行程開關(guān)信號狀態(tài)無變化,再一次檢測行程開關(guān)信號狀態(tài),還是行程開關(guān)信號狀態(tài)無變化,判斷行程開關(guān)失效,設(shè)備停止運(yùn)行,上報(bào)錯誤。
8、其中,運(yùn)動機(jī)構(gòu)運(yùn)行一段距離之后,計(jì)算出運(yùn)動機(jī)構(gòu)運(yùn)行的距離,判斷行程開關(guān)是否失效,并上報(bào)錯誤,所述步驟還包括:
9、運(yùn)動機(jī)構(gòu)運(yùn)行一段距離之后,先計(jì)算出運(yùn)動機(jī)構(gòu)運(yùn)行的距離,當(dāng)運(yùn)動機(jī)構(gòu)再次運(yùn)動回行程開關(guān)過程中,遇到行程開關(guān)信號狀態(tài)變化后,停止運(yùn)動,此時再一次判斷行程開關(guān)信號狀態(tài),若行程開關(guān)信號與運(yùn)動機(jī)構(gòu)停止時的狀態(tài)不一樣時,認(rèn)為行程開關(guān)信號狀態(tài)誤觸發(fā),運(yùn)動機(jī)構(gòu)則繼續(xù)運(yùn)動到行程開關(guān)信號變化停止。
10、其中,運(yùn)動機(jī)構(gòu)運(yùn)行一段距離之后,計(jì)算出運(yùn)動機(jī)構(gòu)運(yùn)行的距離,判斷行程開關(guān)是否失效,并上報(bào)錯誤,所述步驟還包括:
11、若行程開關(guān)信號狀態(tài)與停止時一樣,則計(jì)算出運(yùn)動機(jī)構(gòu)運(yùn)動的距離,判斷回來的距離和出去的距離之間的差值,若出去的距離大于回來的距離,則判斷行程開關(guān)失效,設(shè)備停止運(yùn)行,上報(bào)錯誤。
12、其中,運(yùn)動機(jī)構(gòu)在運(yùn)動回行程開關(guān)過程中,檢測行程開關(guān)信號,判斷行程開關(guān)是否失效,并上報(bào)錯誤,所述步驟還包括:
13、運(yùn)動機(jī)構(gòu)在運(yùn)動回行程開關(guān)過程中,行程開關(guān)信號無變化,則判斷行程開關(guān)失效,設(shè)備停止運(yùn)行,上報(bào)錯誤。
14、本發(fā)明的一種基于mcu與fpga的步進(jìn)電機(jī)報(bào)警控制方法,運(yùn)動機(jī)構(gòu)在運(yùn)動后,對行程開關(guān)的狀態(tài)進(jìn)行檢測,判斷行程開關(guān)是否失效,并上報(bào)錯誤;運(yùn)動機(jī)構(gòu)運(yùn)行一段距離之后,計(jì)算出運(yùn)動機(jī)構(gòu)運(yùn)行的距離,以此判斷行程開關(guān)是否失效,并上報(bào)錯誤;運(yùn)動機(jī)構(gòu)在運(yùn)動回行程開關(guān)過程中,檢測行程開關(guān)信號,判斷行程開關(guān)是否失效,并上報(bào)錯誤。不增加任何傳感器去檢測電機(jī)故障,運(yùn)動可靠性更強(qiáng),當(dāng)光耦失效時,能被檢測出來,防止撞機(jī)損壞設(shè)備,檢測出運(yùn)動機(jī)構(gòu)運(yùn)動異常,保護(hù)設(shè)備。
1.一種基于mcu與fpga的步進(jìn)電機(jī)報(bào)警控制方法,其特征在于,包括以下步驟:
2.如權(quán)利要求1所述的基于mcu與fpga的步進(jìn)電機(jī)報(bào)警控制方法,其特征在于,運(yùn)動機(jī)構(gòu)在運(yùn)動后,對行程開關(guān)的狀態(tài)進(jìn)行檢測,判斷行程開關(guān)是否失效,并上報(bào)錯誤,所述步驟還包括:
3.如權(quán)利要求1所述的基于mcu與fpga的步進(jìn)電機(jī)報(bào)警控制方法,其特征在于,運(yùn)動機(jī)構(gòu)運(yùn)行一段距離之后,計(jì)算出運(yùn)動機(jī)構(gòu)運(yùn)行的距離,判斷行程開關(guān)是否失效,并上報(bào)錯誤,所述步驟還包括:
4.如權(quán)利要求3所述的基于mcu與fpga的步進(jìn)電機(jī)報(bào)警控制方法,其特征在于,運(yùn)動機(jī)構(gòu)運(yùn)行一段距離之后,計(jì)算出運(yùn)動機(jī)構(gòu)運(yùn)行的距離,判斷行程開關(guān)是否失效,并上報(bào)錯誤,所述步驟還包括:
5.如權(quán)利要求1所述的基于mcu與fpga的步進(jìn)電機(jī)報(bào)警控制方法,其特征在于,運(yùn)動機(jī)構(gòu)在運(yùn)動回行程開關(guān)過程中,檢測行程開關(guān)信號,判斷行程開關(guān)是否失效,并上報(bào)錯誤,所述步驟還包括: