The invention discloses a method for controlling a robot in and out of an elevator. The current floor including robots and target position are the same, determine if the robot receives a lift back lift current status information, to determine whether or not the robot to enter the elevator, determine if the robot receives a lift back to information, detect and judge whether the elevator door opened, detecting whether the robot encountered obstacles whether robots successfully entered the elevator and determine if the robot receives a lift back floor to information, detect and judge whether to open the elevator door, determine if the robot receives elevator postback control information to control the robot end; receiving end of lift back out of the elevator control information, robot control. The invention uses the robot and the elevator to carry on the information interaction, and realizes the full-automatic control of the robot in and out of the elevator by the logical judgment, and greatly facilitates the intelligent management of the robot.
【技术实现步骤摘要】
机器人进出电梯控制方法
本专利技术属于机器人控制
,尤其涉及一种机器人进出电梯控制方法。
技术介绍
近年来,移动机器人被大量地应用于各类室内环境用于实现室内运输任务,比如各种制造工厂、现代实验室等。早期的室内运输环境通常是单楼层的,所以机器人不需要自己去控制电梯。但随着现代机器人运输任务的智能化与复杂化,机器人需要实现自动控制各类电梯实现多楼层的自动化管理。因此,机器人如何实现对电梯的自动操控已经成为现代多楼层移动机器人管理系统研发的重点技术瓶颈之一。
技术实现思路
本专利技术的专利技术目的是:为了解决现有技术中存在的以上问题,本专利技术提出了一种机器人进出电梯控制方法。本专利技术的技术方案是:一种机器人进出电梯控制方法,其特征在于,包括以下步骤:A、获取机器人需要到达的目标位置信息,判断机器人当前所在楼层与目标位置楼层是否相同;若是,则控制机器人根据目标位置信息进行移动;若否,则进行下一步;B、控制机器人移动至电梯口位置,并向电梯发送电梯连接指令,判断机器人在预设的响应时间内是否接收到电梯当前状态回发信息;若是,则进行下一步;若否,则放弃进入电梯,并上传电梯通信失败信息;C、控制机器人接收电梯当前状态回发信息,判断机器人是否需要进入电梯;若是,则进行下一步;若否,则放弃进入电梯,并上传电梯故障无法进入信息;D、控制机器人向电梯发送当前所在楼层信息,利用电梯控制板控制电梯向机器人当前所在楼层移动,判断机器人在预设的响应时间内是否接收到电梯回发到达当前所在楼层信息;若是,则进行下一步;若否,则放弃进入电梯,并上传电梯繁忙信息;E、控制机器人接收电梯到达当前 ...
【技术保护点】
一种机器人进出电梯控制方法,其特征在于,包括以下步骤:A、获取机器人需要到达的目标位置信息,判断机器人当前所在楼层与目标位置楼层是否相同;若是,则控制机器人根据目标位置信息进行移动;若否,则进行下一步;B、控制机器人移动至电梯口位置,并向电梯发送电梯连接指令,判断机器人在预设的响应时间内是否接收到电梯当前状态回发信息;若是,则进行下一步;若否,则放弃进入电梯,并上传电梯通信失败信息;C、控制机器人接收电梯当前状态回发信息,判断机器人是否需要进入电梯;若是,则进行下一步;若否,则放弃进入电梯,并上传电梯故障无法进入信息;D、控制机器人向电梯发送当前所在楼层信息,利用电梯控制板控制电梯向机器人当前所在楼层移动,判断机器人在预设的响应时间内是否接收到电梯回发到达当前所在楼层信息;若是,则进行下一步;若否,则放弃进入电梯,并上传电梯繁忙信息;E、控制机器人接收电梯到达当前所在楼层信息,检测并判断电梯门是否打开;若是,则进行下一步;若否,则放弃进入电梯,控制机器人向电梯发送放弃乘坐信息,同时上传电梯开门故障信息;F、利用电梯控制板控制电梯开门按钮触发保持电梯开门状态,通过检测机器人是否遇到障碍判 ...
【技术特征摘要】
1.一种机器人进出电梯控制方法,其特征在于,包括以下步骤:A、获取机器人需要到达的目标位置信息,判断机器人当前所在楼层与目标位置楼层是否相同;若是,则控制机器人根据目标位置信息进行移动;若否,则进行下一步;B、控制机器人移动至电梯口位置,并向电梯发送电梯连接指令,判断机器人在预设的响应时间内是否接收到电梯当前状态回发信息;若是,则进行下一步;若否,则放弃进入电梯,并上传电梯通信失败信息;C、控制机器人接收电梯当前状态回发信息,判断机器人是否需要进入电梯;若是,则进行下一步;若否,则放弃进入电梯,并上传电梯故障无法进入信息;D、控制机器人向电梯发送当前所在楼层信息,利用电梯控制板控制电梯向机器人当前所在楼层移动,判断机器人在预设的响应时间内是否接收到电梯回发到达当前所在楼层信息;若是,则进行下一步;若否,则放弃进入电梯,并上传电梯繁忙信息;E、控制机器人接收电梯到达当前所在楼层信息,检测并判断电梯门是否打开;若是,则进行下一步;若否,则放弃进入电梯,控制机器人向电梯发送放弃乘坐信息,同时上传电梯开门故障信息;F、利用电梯控制板控制电梯开门按钮触发保持电梯开门状态,通过检测机器人是否遇到障碍判断机器人是否成功进入电梯;若是,则进行下一步;若否,则放弃进入电梯,控制机器人向电梯发送放弃乘坐信息,同时上传电梯进入故障信息;G、控制机器人进入电梯,并向电梯发送进入成功信息和目标位置楼层信息;控制电梯接收所述进入成功信息和目标位置楼层信息,解除电梯开门按钮触发,并向机器人目标位置楼层移动;判断机器人在预设的响应时间内是否接收到电梯回发的到达目标位置楼层信息,若是,则进行下一步;若否,则对机器人通信故障进行处理;H、控制机器人接收电梯回发的到达目标位置楼层信息,并利用电梯控制板控制电梯开门按钮触发保持电梯开门状态,检测并判断电梯门是否打开;若是,则进行下一步;若否,则对机器人离开电梯故障进行处理;I、控制机器人离开电梯,并向电梯发送离开成功信息;控制电梯接收所述离开成功信息并向机器人回发结束控制信息,解除电梯开门按钮触发;判断机器人是否接收到电梯回发的结束控制信息,若是,则进行下一步;若否,则上传电梯通信故障信息;J、控制机器人接收电梯回发的结束控制信息,完成机器人进出电梯控制。2.如权利要求1所述的机器人进出电梯控制方法,其特征在于,所述步骤C中电梯当前状态回发信息包括电梯当前楼层、电梯上下行运动状态、电梯内呼状态、电梯通信状态及电梯报警状态信息。3.如权利要求2所述的机器人进出电梯控制方法,其特征在于,所述步骤C中判断机器人是否进入电梯具体包括以下分步骤:C1、利用机器人判断电梯是否处于报警状态;若是,则放弃进入电梯...
【专利技术属性】
技术研发人员:陈鹏,梁浩峰,鄢治江,李卿,孙家弼,
申请(专利权)人:成都普诺思博科技有限公司,
类型:发明
国别省市:四川,51
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。