Electric drive control system with built-in guidance and safety monitoring
Through an electric drive control system with integrated navigation and safety monitoring, the complex architecture and high cost problems in the prior art are solved, and efficient navigation and safety monitoring in light-weight load-bearing vehicles and mobile robots are achieved.
Patent Information
- Application Number
- CN202380023100.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Priority Date
- 2022-02-22
- Filing Date
- 2023-02-21
- Publication Date
- 2024-12-03
AI Technical Summary
The existing autonomous mobile vehicles’ navigation and safety monitoring functions in dynamic environments are handled by different modules, resulting in complex architecture and high cost, making it difficult to integrate into light-loaded vehicles or mobile robots.
Design an electric drive control system that integrates navigation and safety monitoring. Through electronic control interfaces, safety processors and navigation monitoring processors, combined with safety scanner information, the integration of safety functions and navigation functions is achieved, reducing size and cost.
The processing of safety monitoring and navigation functions in a single module is realized, simplifies architecture, reduces costs, and improves the versatility and applicability of the system, suitable for light-load-bearing vehicles and mobile robots.
Smart Images

Figure CN119072415A_ABST
Abstract
Description
Technical Field
[0001] The present disclosure relates to an electric drive control system with integrated navigation and safety monitoring designed to drive the drive wheels of a vehicle.
[0002] The present disclosure also relates to a self-driving assembly and a self-guided vehicle equipped with such a driving control system. Background Art
[0003] Load transport vehicles, such as picking trolleys used in storage warehouses or trolleys for transporting mechanical parts between two workstations in a factory, can be equipped with an electric drive system, allowing the user to move the vehicle with little or limited effort. However, it should be noted that, for example, in storage warehouses with long aisles, the use of such almost manual trolleys involves the operator traveling a long route, which can lead to fatigue and loss of time when the route is not optimized. In addition, the operator must be fully aware of the location of the stored items and the layout of the warehouse in order not to waste time.
[0004] In order to improve the management of logistic processes, technologies guided by wire or laser are used to guide the movement of motorized trolleys in a workspace (for example, in a warehouse) without the need for human intervention. This technology relies on external elements or reference points, such as markers, buried wires or paint strips, arranged along the route traveled by the trolley. This guidance technology imposes fixed tracks and specific infrastructure on the trolley.
[0005] In order to be able to easily adapt the trajectory of a vehicle to changes in the workspace in which it moves, autonomous mobile robots (AMRs) have emerged in recent years, which move autonomously and freely in environments such as storage warehouses without human intervention and without external elements by means of geo-guidance technology.
[0006] Geo-guidance technology is based on mapping the environment in which the vehicle moves. It allows the vehicle to autonomously locate itself in the working environment and automatically calculate its route. To do this, the vehicle is usually equipped with a lidar system that makes it possible to acquire multiple shots of the environment. These shots are then sent to a central computer remote from the vehicle in order to generate a virtual reconstruction of the environment by using appropriate algorithms.
[0007] However, in factories and warehouses, there may be operators and other vehicles moving around. Therefore, in such a dynamic environment, it is necessary to be able to monitor the trajectory of the autonomous vehicle to ensure its correct operation while ensuring the safety of the moving operators. Information acquired by the lidar system or other sensors, known as safety information, is sent to a controller coupled to the drive system, which is able to disconnect the power supply to the motor or can engage the braking system to slow down the vehicle when an obstacle is detected in a predefined area.
[0008] At present, enhanced environmental information and safety information are processed by a set of different modules. Therefore, navigation functions and safety functions are ensured by different and different devices. In other words, the autonomous vehicle is equipped with a navigation system and a safety system to ensure its movement in the environment. Therefore, this generates a large number of necessary modules to ensure safety and navigation functions, resulting in a fragmented, relatively complex and expensive architecture, which is not very suitable for full integration in wheeled devices such as light load-bearing vehicles or mobile robots.
[0009] The present disclosure aims to overcome these drawbacks by proposing a drive control system that makes it possible to integrate and combine safety monitoring functions and navigation functions in a single module, while reducing size and ultimately cost. Summary of the invention
[0010] The present disclosure will improve this situation.
[0011] A system for controlling at least one electric motor of a self-guided vehicle is proposed, the system comprising:
[0012] - at least one electronic control interface, each associated with an electric motor; at least one operational safety processor connected to at least one electronic control interface in order to control the at least one electric motor based on safety information originating from a safety scanner; and a navigation monitoring processor configured to process environmental information originating from the safety scanner.
[0013] According to one embodiment, said at least one control interface comprises two electronic control interfaces, each associated with an electric motor, said safety processor being connected to said two electronic control interfaces in order to control said two motors based on safety information transmitted by the scanner.
[0014] According to another embodiment, the at least one control interface comprises two electronic control interfaces, each of which is associated with an electric motor, and the at least one operational safety processor comprises two safety processors, each of which is connected to the electronic control interface in order to control the two motors based on safety information transmitted by the scanner.
[0015] The features set out in the following paragraphs can optionally be implemented independently of each other or in combination with each other.
[0016] The safety processor is configured to determine whether an obstacle is detected in the field of view of the safety scanner based on the received safety information, and to perform at least one of the following safety functions:
[0017] - the "STO" safety function, which corresponds to electrically disconnecting the motor to eliminate the torque;
[0018] - the "SDI" safety function, which corresponds to preventing one of the two directions of rotation of the motor;
[0019] - the "SLS" safety function, which corresponds to limiting the rotation of the motor to a maximum speed;
[0020] - the "SS1" safety function, which corresponds to braking the motor by controlled deceleration;
[0021] - "SBC" safety function, which corresponds to stopping the motor by engaging the brake.
[0022] The navigation monitoring processor is configured to monitor the navigation of the vehicle by performing the following navigation functions:
[0023] - calculating at least one trajectory to be executed by the vehicle in the environment based on the information transmitted by the central monitoring unit;
[0024] - reading enhanced information about the environment, said enhanced information being acquired by said at least one safety scanner while the vehicle is moving in the environment;
[0025] - Reconstruct the environment and determine the vehicle's position within it;
[0026] - predicting at least one path to be followed by the vehicle and adapting the trajectory to the environment.
[0027] According to another aspect, a self-driving assembly for a self-guided vehicle is provided, comprising:
[0028] - at least one electric motor which generates a rotational movement;
[0029] - an energy source configured to store and return the energy required for the autonomous operation of said assembly;
[0030] - A system for controlling said at least one electric motor as defined above.
[0031] According to one embodiment of the present invention, the component includes a base frame and an outer special-shaped shell forming an external shell, the base frame includes a storage space for storing the electric motor and keeping it in an appropriate position, a first inner special-shaped shell and a second inner special-shaped shell, the first inner special-shaped shell and the second inner special-shaped shell are assembled together to form a tight internal shell, the energy source and the control system are stored in the tight internal shell, and the shell is also stored in the storage space of the external shell.
[0032] Preferably, the second inner profiled shell forms a user interface, which includes a communication connector, a recharging connector and a component for indicating the charging status of the energy source. The user interface is positioned facing the opening formed in the outer profiled shell so that the recharging connector and the indicating component are accessible and visible from outside the shell.
[0033] According to one embodiment, the energy source comprises at least one accumulator of the Ni-MH or Li-ion type.
[0034] Preferably, the electric motor is coupled to the drive wheel by means of an epicyclic reduction gear.
[0035] According to another aspect, a self-guided vehicle is proposed, comprising at least one drive wheel driven by a self-driving assembly as defined above, and at least one safety scanner configured to acquire safety information and enhanced information about the environment in which the vehicle is moving.
[0036] According to one embodiment, the safety scanner is connected to the safety monitoring processor and the navigation monitoring processor via a bus for transmitting safety information and a bus for transmitting enhanced information about the environment, respectively.
[0037] Preferably, said at least one safety scanner is a LiDAR system. BRIEF DESCRIPTION OF THE DRAWINGS
[0038] Other features, details and advantages will become apparent upon reading the following detailed description and analyzing the accompanying drawings, in which:
[0039] Figure 1
[0040] [ Figure 1 ] Figure 1 A drive control system according to one embodiment is shown.
[0041] Figure 2
[0042] [ Figure 2 ] Figure 2 A drive control system according to a second embodiment is shown.
[0043] Figure 3
[0044] [ Figure 3 ] Figure 3 A drive control system according to a third embodiment is shown.
[0045] Figure 4
[0046] [ Figure 4 ] Figure 4 Exhibition includes Figure 1 An exploded view of the self-driving components of the drive control system.
[0047] Figure 5
[0048] [ Figure 5 ] Figure 5 Schematically depicting a Figure 1 A top view of a drive control system driving a drive wheel of an automatically guided transport vehicle.
[0049] Figure 6
[0050] [ Figure 6 ] Figure 6 A perspective view of a self-guided transport vehicle is schematically depicted, according to one embodiment, comprising two motors driven by a drive control system. DETAILED DESCRIPTION
[0051] In the various drawings, the same reference numbers refer to the same or similar elements.
[0052] In the scope of the present disclosure, an environment means, for example, a warehouse, a production plant or any other industrial space where light vehicles move.
[0053] Within the scope of the present disclosure, a light vehicle that moves autonomously in an environment may be, for example, a transport trolley or any other wheeled transport device or a mobile robot.
[0054] Within the scope of the present invention, a safety scanner is a device commonly used in autonomous mobile robotics for sensing the environment, making it possible on the one hand to have operational safety information related to the presence of obstacles in preconfigured risk areas and on the other hand to send back distance information known as enhanced information about the environment relative to the surrounding elements. The safety information is generally used for the purpose of preventing dangerous actions or engaging safety devices. Non-safety distance information can be used to reconstruct a map of the environment and calculate positioning relative to it, which is useful information for the navigation of autonomous mobile devices.
[0055] In the context of the present disclosure, "enhanced information about the environment" is understood to mean a set of coordinates of points detected in the field of view of one or more security scanners capable of capturing a picture of the environment of the device. This information is used to feed and enhance the navigation algorithm of the vehicle in order to reconstruct the environment in which the vehicle moves and obtain the positioning of the device in the reconstructed environment.
[0056] refer to Figure 1 , depicts a drive control system 1 for a lightweight self-guided vehicle according to one embodiment.
[0057] The control system 1 has a function of controlling a motor of the vehicle based on the safety information and the enhanced information on the environment, both of which are transmitted by the safety scanner 5 .
[0058] According to the invention, the drive control system 1 is directly integrated into the self-propelled component 20 in order to drive, for example, one or two drive wheels. Figure 1 In the example of FIG. 2 , the assembly 20 is configured to drive a drive wheel 201 .
[0059] Will refer to below Figure 4 The autonomous component 20 is described in more detail. It may comprise an electric motor 22 configured to generate a rotational movement, an energy source 21 that stores and returns the energy required for the autonomous operation of the autonomous component.
[0060] The security scanner 5 is capable of capturing information about the environment in which the light vehicle moves. The security scanner may include, but is not limited to, a camera for two-dimensional photography, a camera for three-dimensional photography, a LiDAR system, or any other equivalent system for acquiring multiple pictures of the environment. The data from the scanner 5 may be of two distinct types. The data may include security information indicating, for example, a presence detected in a predefined area, indicating a security risk, and enhanced information about the environment, the enhanced information including all physical points detected in the detection field of the scanner 5.
[0061] The drive control system 1 comprises an electronic control interface 3 configured to control the operation of the motor 22, a safety processor 2 connected to the electronic control interface 3 so as to control the operation of the motor 22 based on the safety information originating from the scanner 5. The control system 1 also comprises a navigation monitoring processor 4 configured to monitor the navigation of the vehicle based on enhanced information about the environment, this information originating from the scanner 5. The processed information allows the drive control system 1 to have a dual function: to control the operation of the motor according to the safety information, and to guide the vehicle by reconstructing the environment in which the device moves.
[0062] The safety information and the enhanced information about the environment are processed by two distinct processors, namely an operational safety processor 2 for the motor and a navigation monitoring processor 4, both integrated in the same physical entity, namely the control system 1 for the motor. Advantageously, the operational safety processor 2 and the navigation monitoring processor 4 can thus be integrated together in a single device. Unlike known solutions that propose different and distinct devices for ensuring navigation and safety functions, these functions are ensured by a single device. Bringing together the safety monitoring processor and the operational safety processor in the drive system allows the same system to process both environmental information and safety information originating from sensors. This integration makes the drive system more versatile and directly compatible with safety scanners.
[0063] The operational safety processor 2 is coupled to the motor 22 by means of an electronic control interface 3. The operational safety processor 2 controls the electronic control interface 3 in order to monitor the motor 22 and integrate at least one of the following safety functions:
[0064] - electrically disconnecting the motor 22 to eliminate the torque, corresponding to the STO (Safe Torque Off) safety function,
[0065] - if there is an obstacle on one side of the vehicle, one of the two directions of rotation is prevented, corresponding to the so-called SDI (Safe Direction) safety function,
[0066] - limiting the rotation to a maximum speed, making it possible to transition to safe limited speed mode when an obstacle is detected in the field of view, corresponding to the so-called SLS (Safe Limited Speed) safety function,
[0067] - braking the motor by controlled deceleration if an approaching obstacle is detected, corresponding to the so-called SS1 (Safe Stop) safety function,
[0068] - Stopping the motor by engaging the brake corresponds to the so-called SBC (Safe Brake Control) safety function.
[0069] The operational safety processor 2 is connected to the safety scanner 5 via a link 7 for transmitting safety information or via a communication bus 7. Safety functions can be activated independently depending on the safety information transmitted by the scanner 5 to the operational safety processor 2. The communication bus can be, for example, a communication network dedicated to safety, such as CANopen Safety, PROFIsafe or FSoE (Fail-Safe over Ethercat).
[0070] According to an exemplary embodiment, when the SLS safety function is activated and the motor control is in speed-limited mode, the safety monitoring processor transmits information to the scanner 5 requesting it to reduce the distance of the detection field. According to another exemplary embodiment, when the rotation speeds of the two drive wheels are different, the safety monitoring processor transmits information to the scanner 5 requesting it to adapt the positioning of the detection field to the orientation imposed by the speed difference of the drive wheels.
[0071] The navigation monitoring processor 4 is configured to monitor the navigation of the vehicle based on the enhanced environmental information originating from the scanner 5 .
[0072] The navigation monitoring processor 4 is configured to perform monitoring of the vehicle navigation based on enhanced information about the environment, which information originates from the data acquisition device 5:
[0073] - calculating at least one trajectory to be executed by the vehicle in the environment;
[0074] - rebuilding said environment;
[0075] - determining the location of the vehicle in said reconstructed environment;
[0076] - predicting at least one path to be followed by the vehicle and adapting the trajectory to the environment.
[0077] The navigation monitoring processor 4 is also configured to be able to communicate with a fixed central unit 71 located remotely from the vehicle, such as Figure 6 The navigation monitoring processor 4 receives a mission command to be performed by the vehicle and also receives a database of coordinates of points of the environment in which the vehicle must move. The navigation monitoring processor 4 processes the mission command to be performed by the vehicle and determines a trajectory to be taken in the environment.
[0078] In order to generate a reconstruction of the environment based on augmented information about it, which augmented information may come, for example, from various photographs, several algorithms from the prior art can be used, depending on the sensors envisaged for the system used to perceive the environment. For example, if the sensor used to perceive the environment is a camera or a lidar, algorithms of the “SLAM” type make it possible to obtain a two-dimensional or three-dimensional reconstruction of the environment. In the context of a lidar or laser type sensor, the various individual reconstructions can be assembled into a single overall reconstruction by using a method of the ICP (Iterative Closest Point) type.
[0079] The navigation monitoring processor 4 and the scanner 5 are connected via a data transmission link 6 , thereby allowing the navigation monitoring processor 4 to access data measured by the scanner 5 and also transmit data to the scanner 5 .
[0080] The navigation monitoring processor 4 and the safety processor 2 are connected together via a link 8 , which may be a non-safety communication bus of the serial bus, CANopen, PROFInet or EtherCAT type, for example.
[0081] In known solutions, safety information and enhanced information about the environment are processed by different devices. Safety information is usually sent to a safety logic that is able to disconnect the power supply to the motor or engage the brakes of the motor, while enhanced information about the environment is processed by a computing unit outside the vehicle. In a vehicle that navigates in an autonomous manner, a large number of devices are required to ensure all safety and navigation functions. Due to the specific integrated architecture of the drive control system of the present invention, it is possible to combine the safety monitoring functions and the navigation functions in a single and compact physical entity, giving the drive system of the present invention a modular nature.
[0082] The drive control system according to the present disclosure is particularly suitable for integration in a self-driving assembly in order to drive the drive wheels of a light vehicle. One of the main advantages of the system of the invention is the simplicity of its architecture and implementation, while ensuring automatic guidance and its safety in a dynamic environment.
[0083] refer to Figure 2 , shows a drive control system 10 according to a second embodiment.
[0084] Figure 2 The drive control system makes it possible to control the two electric motors 42.1, 42.2 of the self-driving assembly 40 in order to drive the drive wheels 301, 302 of the vehicle 300. The assembly 40 further comprises a rechargeable energy source 41 in order to supply power to the motors.
[0085] The control system 10 comprises a first electronic control interface 13.1 coupled to the first motor 42.1 and a second electronic control interface 13.2 coupled to the second motor 42.2, a safety processor 12 connected to the two control interfaces 13.1, 13.2 for controlling the two motors 42.1, 42.2 based on safety information originating from the safety scanner 15.
[0086] The control system also includes a navigation monitoring processor 14 configured to process enhanced information about the environment, this information originating from the scanner 15 .
[0087] The operational safety processor 12 is connected to the safety scanner 15 via a link 17 for transmitting safety information or via a communication bus 17. Safety functions can be activated depending on the safety information transmitted by the scanner 15 to the operational safety processor 12. The communication bus can be, for example, a communication network dedicated to safety, such as CANopen Safety, PROFIsafe or FSoE (Fail-Safe over Ethercat).
[0088] The navigation monitoring processor 14 and the scanner 15 are connected together via a data transmission link 16 such as Ethernet or USB, thereby allowing the navigation monitoring processor 14 to access data measured by the scanner 15 and also transmit data to the scanner 15 .
[0089] The navigation monitoring processor 14 and the safety processor 12 are connected together via a link 18 , which may be a non-safety communication bus of the serial bus, CANopen, PROFInet or EtherCAT type, for example.
[0090] Advantageously, the architecture of the control system is particularly flexible. Thus, the number of electronic control interfaces can be adjusted according to the number of motors to be controlled.
[0091] refer to Figure 3 , shows a drive control system 100 according to a third embodiment.
[0092] Figure 3 The drive control system 100 also makes it possible to control the two electric motors 52.1, 52.2 of the self-driving assembly 50 to drive the two driving wheels 401, 402 of the vehicle 400. The assembly 50 further comprises a rechargeable energy source 51 in order to supply power to the motors.
[0093] The control system 100 includes a first electronic control interface 103.1 coupled to the first motor 52.1 and a second electronic control interface 103.2 coupled to the second motor 52.2, a first operation safety processor 102.1 connected to the first control interface 103.1 and a second operation safety processor 103.2 connected to the second control interface 103.2 to control the two motors 52.1 and 52.2 respectively based on safety information originating from the safety scanner 105.
[0094] The control system also includes a navigation monitoring processor 104 configured to process enhanced information about the environment, this information originating from the scanner 105 .
[0095] In this configuration, the scanner 105 is connected only to the first operational safety processor 102.1 and the navigation monitoring processor 104 of the system 100 via a bus 107 for transmitting safety information and a bus 106 for transmitting enhanced information about the environment, respectively. The first safety processor 102.1 is connected to the second operational safety processor 102.2 via a bus 109 for transmitting safety information in order to transmit safety information originating from the scanner 105.
[0096] The navigation monitoring processor 104 and the first safety processor 102 . 1 are connected together via a link 108 , which may be a non-safety communication bus of the serial bus, CANopen, PROFInet or EtherCAT type, for example.
[0097] The drive control system of the present invention is in the form of a control board that can be easily integrated in a housing along with one or more motors and a rechargeable energy source to form a self-driving assembly.
[0098] refer to Figure 4 , an exploded view shows an exemplary embodiment of a self-driving assembly 20 with an integrated drive control system, which may be Figures 1 to 3 A control system of one of the.
[0099] The assembly 20 comprises an external housing that supports and brings together all the elements for driving and controlling the drive wheel 201 (i.e. one or more electric motors 22 that can generate a rotational movement), an energy source 21, a control system 1 of the electric motors (in the form of an electronic board) and an interface 24 for managing the elements.
[0100] The energy source 21 comprises a rechargeable battery capable of storing and returning the energy required for the autonomous operation of the self-driving assembly 20. According to one exemplary embodiment, the battery comprises a Ni-MH battery. According to another exemplary embodiment, the battery comprises a Li-ion battery.
[0101] The outer shell is formed by a base frame 23 and an outer shell 25 that are assembled and fixed together. The base frame 23 includes a storage space 28 for receiving an inner shell formed by a first inner profile shell 27 and a second inner profile shell 24 assembled to the first shell 27. The first profile shell 27 is sized and configured to be assembled in the storage space 28 of the base frame 23. The base frame 23 also supports the drive wheel 201 and includes a shell delimited by the inner shell and designed to receive the electric motor 22. Therefore, the wall of the inner shell 27 forms an interface between the energy source 21 and the motor 22. The inner shell 27 also includes a storage space 29 for receiving the energy source 21 and the control system 1.
[0102] The first shell 27 can be made of an electrically insulating material and possesses enhanced mechanical properties, which makes it possible to ensure the containment of the components and resistance to mechanical stresses (such as vibrations and / or shocks) suffered during operation. The material of the shell is, for example, a composite material. It can be made of plastic reinforced with glass fibers.
[0103] Preferably, the two inner profile shells 27 and 24 comprising the electronic system 1 can be assembled together to obtain a tight housing. In addition, a seal is positioned between the two shells and the parts constituting the housing.
[0104] The electric motor 22 comprises a motor shaft 22A. The control system 1 of the motor in the form of an electronic board comprises a hole 9 through which the shaft of the motor shaft is received. At the axial end of the motor, a flange 22F is arranged on one face of the motor housing in order to form an interface between the rear end of the motor 22 and the electronic board 1. The electronic system 1 comprises a power electronics interface 3, an operational safety processor 2 and a navigation monitoring processor 4 in order to control the electric motor 22 based on safety information and enhanced information about the environment, this information originating from a scanner 5. The electronic system 1 also comprises a communication interface, such as a Wifi connection, in order to transmit data to a fixed central unit 71, such as Figure 6 The electronic system 1 may be composed of a plurality of electronic boards assembled to each other.
[0105] According to an exemplary embodiment, the second inner profiled shell 24 is equipped with a management interface of the housing and may include, for example, a communication interface connection, a recharging connection, and means for indicating the operating state and the charging state of the energy source. The management interface 24 is positioned facing the opening 26 formed in the outer profiled shell 25, so that the communication connection, the recharging connection and the indicating means are accessible and visible from outside the housing.
[0106] Wheel 201 via Figure 4 The epicyclic reduction gear, not depicted in FIG. 2 , is coupled to the electric motor 22 of the self-driving assembly 20. The wheel 201 may be a non-directional drive wheel that moves the vehicle forward or backward in a main direction of movement associated with the vehicle, the direction of movement being perpendicular to the axis of rotation of the non-directional wheel. The wheel may be a directional motor. The wheel may be oriented by pivoting about a vertical pivot axis to guide the vehicle along its route.
[0107] The architecture of the self-drive assembly of the invention is particularly advantageous. In particular, it makes it possible to assemble all the elements of the drive assembly in a single housing, thereby forming a single modular functional block to be coupled to the wheel. In addition, the elements of the self-drive assembly are contained in a robust and completely tight fairing, allowing the wheel to operate in the most demanding environments.
[0108] refer to Figure 5 , the following describes Figure 4An exemplary drive architecture for a light vehicle 200 having a self-driving assembly.
[0109] Typically, one or more drive wheels can be used to provide traction or propulsion functions for the movement of a wheeled device. A wheeled vehicle can move on a single autonomous drive wheel, on several drive wheels, on a set of drive wheels and non-drive wheels. The wheels can be fixed or pivoting. A fixed wheel is understood to mean a wheel that maintains the same orientation relative to the base of the device regardless of the direction of movement of the device. A pivoting wheel is understood to mean a wheel with a horizontal axle that pivots around a vertical axle so as to make it possible to change the direction of movement of the device to which the wheel is fixed. The axle of a wheel is a horizontal axle that passes through the center of rotation of the wheel.
[0110] Depending on the geometry of the vehicle, the number of wheels and the distribution of the loads, several layouts of the drive wheels may be considered to ensure correct operation of one or more drive wheels.
[0111] exist Figure 5 In the embodiment of the invention, a wheeled vehicle 200 comprises four non-driven pivoting wheels 61, 62, 63, 64 and one driving wheel 201. The driving wheel is arranged in a central position relative to the base of the vehicle and allows electrical assistance for moving the vehicle. The wheel 201 is coupled to the wheel 201 by means of an epicyclic reduction gear. Figure 4 The wheeled vehicle 200 further comprises a safety scanner 5 configured to acquire safety information and enhanced information about the environment in which the self-guided vehicle moves.
[0112] refer to Figure 6 , the following describes the steps for implementing a self-guiding method for a light vehicle 500 equipped with a drive assembly of the present invention.
[0113] The light vehicle 500 is equipped with four fixed wheels 61, 62, 63, 64 and two driving wheels 501, 502. The two driving wheels are each equipped with Figure 4 The front and rear of the vehicle are equipped with safety scanners 505, 515.
[0114] In a first step, the fixed navigation monitoring central unit 71 transmits a mission command to the navigation monitoring processors of the two self-driving assemblies 20.1, 20.2. For example, the mission command may be a path to travel between a starting position A and an end position B according to a given trajectory. In addition, the navigation monitoring central unit 71 also transmits a database representing the environment in which the vehicle moves. For example, the database is in the form of a 3D point cloud.
[0115] In a second step, the navigation monitoring processor calculates a trajectory which is transmitted in the form of instructions to the safety processor which controls the motors in order to move the vehicle in the environment.
[0116] In a third step, one of the scanners 505, 515 acquires information about the environment based on multiple shots of the environment while the vehicle is moving. Figure 6 In the embodiment, this is for example a scanner with reference numeral 505, which is activated to take pictures while the vehicle is moving. If the scanner is constituted by a camera or a lidar, for example, multiple images of the environment are acquired. These multiple images can be, for example, images of the same scene taken from various spatial viewpoints. The information consists of enhanced information about the environment and safety information.
[0117] In a fourth step, the scanner 505 transmits enhanced information about the environment to the navigation processor 4 and transmits safety information to the operational safety processor 2.
[0118] In a fifth step, the navigation monitoring processor uses the received enhanced information about the environment to perform the following navigation functions: reconstructing the environment based on the enhanced information about the environment; determining the position of the vehicle in this reconstructed environment and predicting a path to be followed by the vehicle; and adapting the route relative to the reconstructed environment. The operational safety processor uses the received safety information to perform one of the safety functions. According to one configuration, if the safety processor determines that there is an obstacle on one side of the vehicle based on the safety information, the safety processor transmits a control signal to the control interface 3 to prevent one of the two rotation directions. According to Figure 6 In another configuration shown in FIG, if an obstacle is detected in the field of view (e.g., an operator 70), the safety processor transmits a signal to the control interface 3 to limit the rotation speed of the two drive wheels 501, 502. According to yet another configuration, if an obstacle is detected in the immediate distance from the vehicle, the processor can activate the SS1 function to engage the brakes of the motors through controlled deceleration.
[0119] In the sixth step, when the vehicle reaches the destination, the self-driving assembly stops the motor.
[0120] When the vehicle is moving, the drive control system 1 may communicate with a fixed remote central unit 71 to exchange data.
[0121] Industrial Applications
[0122] The technical solution of the present invention can be used in various fields of industrial applications, such as the automotive industry, the food processing industry, and the logistics industry, in order to equip industrial handling trolley-type equipment to transport spare parts or items between workstations or work units, thereby optimizing the logistics process while maintaining the safety of the operator.
Claims
1. A system (1, 10, 100) for controlling at least one electric motor (22) of a self-guided vehicle, the system comprising: - at least one electronic control interface (3, 13.1, 13.2, 103.1, 103.2), each of which is associated with an electric motor (22, 42.1, 42.2, 52.1, 52.2); at least one operational safety processor (2, 12, 102.1, 102.2), which is connected to at least one electronic control interface (3, 13.1, 13.2, 103.1, 103.2) in order to control the at least one electric motor based on safety information originating from a safety scanner (5, 15, 105); and a navigation monitoring processor (4, 14, 104) configured to process environmental information originating from the safety scanner (5).
2. The system (10) according to claim 1, characterized in that The at least one control interface (3, 13.1, 13.2) comprises two electronic control interfaces (13.1, 13.2), each associated with an electric motor (42.1, 42.2), the safety processor (12) being connected to the two electronic control interfaces (13.1, 13.2) to control the two motors based on safety information transmitted by the scanner (15).
3. The system (100) according to claim 1, characterized in that The at least one control interface (3, 103.1, 103.2) comprises two electronic control interfaces (103.1, 103.2), each of which is associated with an electric motor (52.1, 52.2), and the at least one operational safety processor comprises two operational safety processors (102.1, 102.2), each of which is connected to the electronic control interface (103.1, 103.2) to control the two motors based on safety information transmitted by the scanner (105).
4. The system according to any one of claims 1 to 3, characterized in that The at least one safety processor (2, 12, 102.1, 102.2) is configured to determine whether an obstacle is detected in the field of view of the safety scanner (5, 15, 105) based on the received safety information, and to perform at least one of the following safety functions: - a "STO" safety function, which corresponds to electrically disconnecting the motor in order to eliminate the torque; - a "SDI" safety function, which corresponds to preventing one of the two directions of rotation of the motor; - a "SLS" safety function, which corresponds to limiting the rotation of the motor to a maximum speed; - a "SS1" safety function corresponding to braking the motor by controlled deceleration; - a "SBC" safety function, which corresponds to stopping the motor by engaging the brake.
5. The system according to any one of claims 1 to 4, characterized in that The navigation monitoring processor (4, 14, 104) is configured to monitor the navigation of the vehicle by performing the following navigation functions: - calculating at least one trajectory to be executed by the vehicle in the environment based on the information transmitted by the central monitoring unit (71); - reading enhanced information about the environment, the enhanced information being acquired by the at least one safety scanner (5, 15, 105) while the vehicle is moving in the environment; - reconstructing the environment and determining the location of the vehicle in the environment; - predicting at least one path to be followed by the vehicle and adapting the trajectory to the environment.
6. A self-driving assembly (20, 40, 50) for a self-guided vehicle, comprising: - at least one electric motor (22, 42.1, 42.2, 52.1, 52.2) which generates a rotational movement; - an energy source (21, 41, 51) configured to store and return the energy required for the autonomous operation of the assembly; - System (1, 10, 100) for controlling said at least one electric motor according to any one of claims 1 to 5.
7. The component according to claim 6 comprises a base frame (23) and an outer profiled shell (25) forming an outer shell, the base frame (23) comprising a storage space (28) for storing the electric motor (22) and keeping it in an appropriate position, a first inner profiled shell (27) and a second inner profiled shell (24), the first inner profiled shell and the second inner profiled shell are assembled together to form a tight inner shell, the energy source (21) and the control system (1, 10, 100) are stored in the tight inner shell, and the shell is also stored in the storage space of the outer shell.
8. The assembly according to claim 7, characterized in that The second inner profiled shell forms a user interface (24), which includes a communication connection, a recharging connection and a member for indicating the charging state of the energy source (21, 41, 51), and the user interface (24) is positioned facing the opening (26) formed in the outer profiled shell (25), so that the recharging connection and the indicating member are accessible and visible from outside the shell.
9. Assembly according to any one of claims 6 to 8, characterized in that The energy source (21, 41, 51) comprises at least one storage battery of Ni-MH or Li-ion type.
10. An assembly according to any one of claims 6 to 9, characterized in that The electric motor (22) is coupled to the drive wheel (201) by means of an epicyclic reduction gear.
11. A self-guided vehicle (200, 300, 400, 500) comprising at least one drive wheel (201, 301, 302, 401, 402, 501, 502) driven by a self-driving assembly according to any one of claims 6 to 10, and at least one safety scanner (5, 15, 105, 505, 515), the at least one safety scanner being configured to acquire safety information and enhanced information about the environment in which the vehicle moves.
12. The vehicle according to claim 11, characterized in that The safety scanner (5, 15, 105) is connected to the safety monitoring processor (2, 12, 102.1) and the navigation monitoring processor (4, 14, 104) via a bus (7, 17, 107) for transmitting safety information and a bus (6, 16, 106) for transmitting enhanced information about the environment, respectively.
13. The vehicle according to claim 11 or 12, wherein the at least one safety scanner (5, 15, 105) is a LiDAR system.
