MULTIDIRECTIONAL EFFORT RETENTION CONTROL DEVICE

专利摘要:
A force feedback control device comprising: - a handle (1) manipulated by the user, said handle (1) having a gripping area (101) by the user and a contact end (401) integral with the gripping area at least during a part of the operation of the control device; - a robot (2) having a terminal body (206) having a contact area (402) engageable with the contact end (401); ), - measuring means (3) of the relative configuration of the handle (1) and the terminal body (206), - a controller (5) of the displacement of the contact zone (402) with respect to the end contact (401), - the contact end (401) being movable with respect to the contact area (402) during at least a portion of the operation of the control device, - wherein the contact end (401) and the contact zone (402) have such shapes that the robot applies to the handle (1) a force feedback in a at least two distinct directions during at least a portion of the operation of the controller.
公开号:FR3014348A1
申请号:FR1362268
申请日:2013-12-06
公开日:2015-06-12
发明作者:Franck Gonzalez；Florian Gosselin
申请人:Commissariat a lEnergie Atomique CEA；Commissariat a lEnergie Atomique et aux Energies Alternatives CEA；
IPC主号:

专利说明:

[0001] TECHNICAL FIELD AND PRIOR ART The present invention relates to a multidirectional force feedback control device that can be implemented as a haptic interface, that a system's master arm master-slave or as a device for driving a collaborative robot.
[0002] The haptic interfaces, the master arms for teleoperation and the collaborative robots are formed of poly-articulated mechanical chains comprising a plurality of mobile bodies interconnected by passive or motorized joints connecting a fixed or movable base to one or more handles gripped by the user. The user grasps and moves the handle or handles whose movements are transmitted to all of the body of the robot and generally measured by joint sensors or arranged at the motors. This measurement is used to generate a control signal of an avatar in virtual reality or a distant robot in teleoperation or to activate assistance modes in cobotics. When the avatar or the remote robot collides with their environment or when assistance modes are activated, the robot's motors make it possible to apply force feedback or guidance to the user's hand. These interfaces are all the more intuitive and effective that they are "transparent", ie the user does not feel their presence and has the impression of intervening directly in the virtual or remote environment. In particular, he must be able to move as freely as possible in free space and clearly feel the contacts with the environment. This requires specific designs that minimize the friction and inertia of the robot. Now the handle, which can be for example a standard handle or a pen, is permanently linked to the robot whose bodies are themselves linked together. Thus, when the user moves the handle to control his avatar or a remote robot, he moves the entire robot at the same time. Even if it is optimized to be as transparent as possible, the user will feel the friction and inertia of the entire robot. Thus free space will not be perceived as truly free. In addition, the sensory sensors (tactile and kinesthetic) of the user are permanently solicited and are less sensitive to changes in the environment. In particular the passage from free space to contact will be felt less frankly than in the real world. The Motoki Takagi document, Jumpei Arata, Akihiro Sono, Hideo Fujimoto, A new desktop encounter-type haptic device with an actively driven pen-tablet LCD panel, J. Advanced Robotics, Vol. 27, No. 6, February 2013, pp. 407-415 describes an example of a device in which the effector and the robot are disengaged. This device includes a Wacom®-type graphics tablet and a stylus manipulated by the operator. The tablet is mounted at the end of a parallel robot and the stylus is spotted in space by an optical system. The tablet is then moved in front of the stylus according to the movement of the stylus. The force feedback is managed by the parallel robot actuators according to the level of pressure applied by the stylus to the tablet and picked up by the tablet. Because the pen is separated from the tablet, transparency is provided in free space. However the force feedback applied to the stylus has only one direction which is the normal direction to the tablet. In addition, this force feedback is unilateral, that is to say that the stylus, respectively the tablet, can only push on the tablet, respectively on the stylus, and not the respectively draw. SUMMARY OF THE INVENTION It is therefore an object of the present invention to provide a force feedback control device offering a very high transparency or even a perfect transparency in free space while providing improved force feedback. The previously stated goal is achieved by a control device comprising an element manipulated by the operator (also called interaction element) provided with a contact end, a robot provided with a contact zone with which said contact end can come into contact, said contact end being movable relative to the contact zone at least during a part of the operation of the control device, means for measuring the relative configuration of said element relative to the robot and a controller managing the monitoring without contact, bringing the robot into contact with said element and the force return once the robot and the element in contact. The robot, the contact zone, the manipulated element and the contact end are such that the control device can provide multidirectional force feedback. In other words, the control device is an intermittent contact device cooperating with a contact end and a contact area whose shapes are such that the contact zone can apply forces on the contact end in at least one embodiment. two separate directions. Advantageously, the force return is bilateral in at least one direction. "Bilateral effort feedback" means a force feedback that can be applied in both directions in a given direction.
[0003] The means for measuring the relative configuration of the element manipulated with respect to the robot may advantageously be integrated into the body located at the end of the robot and comprising the contact zone. We can still put transmitters and sensors on the handle and on this contact area. Thus the measurement of the relative position of the handle relative to the robot is known simply and accurately. In another embodiment, temporary securing means may be provided between the contact zone and the contact end. The force feedback can then be multidirectional, bilateral and without play in contact. In another embodiment, the contact area is "deformable" so that the gap between the contact end and the contact area decreases in several directions simultaneously when contact is made. It is thus possible to very realistically simulate fine insertions with successive contacts on the opposite edges of the hole. In an exemplary embodiment, the manipulated element is totally detached from the robot carrying the contact zone. The contact zone is for example formed by a cavity and the element has the shape of a stylet whose one end has a shape corresponding to that of the cavity. When the contact tip of the stylet contacts the cavity, force returns in several directions can be applied to the stylet, for example axial force returns relative to the stylus but also transverse force returns. In another embodiment, the contact end of the manipulated element is "encompassed" by the contact zone, and the manipulated element is separated from the contact zone with a gap in at least one given direction. Thus the manipulated element is free to move on a race equal to a given game and when it has traveled this game in the given direction, it comes into contact with the contact zone which can apply a force feedback. For example, the manipulated element has at its contact end a sphere and the contact zone forms a spherical housing whose inner diameter is greater than that of the sphere, the sphere being mounted in the spherical housing inseparably in operation. The nominal clearance is that between the outer radius of the sphere and the inner radius of the housing, and the force return is obtained by contacting the sphere and the spherical housing. This device allows a translational force return in all directions and bilateral in all directions. The subject of the present invention is therefore a force feedback control device comprising: a handle intended to be handled by the user, said handle comprising at least one user input area and at least one contact end secured to the gripping zone at least during a part of the operation of the control device; - a robot provided with at least one terminal body having at least one contact zone, said contact zone being able to come into contact with the end of contact of the handle, - means for measuring the relative configuration of the handle relative to the terminal body, - a controller adapted to manage the displacement of the contact zone with respect to the contact end in an operating state without contact, in an operating state of contacting the contact zone and the contact end and in a state of operation in contact in which a force feedback can be applied to the handle via the contact end, - the contact end being movable with respect to the contact area during at least a part of the operation of the control device, - in which the end of the contact contact and the contact area have such shapes that the contact area is able to apply forces on the contact end in at least two distinct directions so that the robot applies to the handle a force feedback in said at least two distinct directions. According to an exemplary embodiment, the contact end or the contact zone may form a cavity and the contact zone or the contact end is shaped such that it houses at least partially in said cavity. A clearance may exist between the inner surfaces of said cavity of the contact end or the contact area and the outer surfaces of the contact area or the contact end, so that the relative displacement of the end of contact and contact area is limited in all directions. For example, the contact end has a spherical shape and the contact zone has a corresponding spherical shape where the contact end has a parallelepipedal shape and the contact zone has a corresponding parallelepiped shape. According to another exemplary embodiment, the contact zone or the contact end forms a cavity from which the contact end or the contact zone is free to exit. The contact end may have a cylindrical side wall and a hemispherical end wall and the contact area may have a corresponding shape or the contact end may have a conical or frustoconical side wall and the contact area may have a corresponding form. In one embodiment, the contact area and / or the contact end may have a fixed shape.
[0004] In another embodiment, the handle and / or the terminal body comprise a deformable element for coming into contact with the terminal body and / or the handle respectively when it is deformed. It is advantageously the contact zone and / or the contact end which are deformable. The contact zone and / or the contact end are for example delimited by several surfaces, at least one of which is movable relative to the other surfaces. In an exemplary embodiment, the contact zone and / or the contact end are formed at least in part by a flexible wall, the contacting between the contact zone and the contact end being provided at least in part. by the deformation of the flexible wall. The flexible wall may delimit a closed chamber, said device comprising a reservoir of material in the form of fine powder and means for supplying the closed chamber, on command of the controller.
[0005] The measuring means may comprise a camera or camera flight time arranged so as to film the handle and the terminal body, image processing means provided by the camera and preferably a lighting device. For example, the handle and / or the terminal body comprise at least one registration target.
[0006] According to an additional feature, one or more targets may emit a signal to distinguish them from other targets. According to another additional feature, the measuring means can be arranged on the handle and the terminal body, said measuring means comprising locating elements on the handle or the terminal body and sensors of said registration elements. The identification elements are, for example, light-emitting diodes and the sensors are phototransistors. According to another additional feature, the force feedback control device comprises means for temporarily securing the handle and the terminal body. Advantageously, the temporary fastening means are such that the fastening is eliminated when a sufficient force is applied to the contact end. By way of example, the temporary securing means are magnetic or mechanical means. Alternatively, the temporary fastening means are controllable so as to allow cancellation of the connection to order, and are for example of the electromagnetic type. Advantageously, the force feedback control device comprising at least one alignment system automatically modifying the relative configuration of the handle and the terminal body of the robot in orientation, for example magnetic type. According to another additional feature, the force feedback control device may comprise contact detection means between the contact end and the contact zone. According to another additional feature, the force return control device may comprise at least two contact zones and at least two contact ends, the two contact zones being movable relative to one another and / or the two contact ends being movable relative to each other. The robot can be a serial robot with six degrees of freedom, a hybrid robot with 6 degrees of freedom, a parallel robot with three degrees of freedom or a parallel robot with two or three degrees of freedom. The present invention also relates to a haptic interface comprising a force feedback control device according to the invention and a simulation software.
[0007] The present invention also relates to a master robot system and slave robot comprising a force feedback control device according to the invention and a slave robot, the master robot being formed by the robot of the control device.
[0008] The present invention also relates to a collaborative robot comprising a force feedback control device according to the invention and an effector acting on the environment, mounted on the terminal body or on a separate body. BRIEF DESCRIPTION OF THE DRAWINGS The present invention will be better understood with the aid of the following description and drawings in which: FIG. 1 is a schematic overall representation of the control device according to the invention, FIG. is a perspective view of a first example of a control device according to a first embodiment, - Figures 3A and 3B are detailed views of the device of Figure 2 in perspective and partial section at the element level. of interaction according to the first embodiment, - Figures 4A and 4B are detailed views of a variant of the device of Figures 3A and 3B in perspective and in partial section at the interaction element, - the FIGS. 5A and 5B are detailed views of a control device according to a second exemplary embodiment in perspective and in partial section at the level of the interaction element; FIGS. 6A and 6B are detailed views and FIG. n partial section at the interaction element of a variant of the device of Figures 5A and 5B, - Figures 7A and 7B are partial sectional views at the interaction element of two variants of the device FIGS. 6A and 6B; FIGS. 8A and 8B are detailed perspective and partially sectional views at the level of the interaction element of another variant of the control device of FIGS. 6A and 6B; FIGS. 9A and 9B are detailed perspective and partial sectional views at the level of the interaction element of a variant of the control device of FIGS. 8A and 8B; FIG. 10 is a partial sectional view of a variant of the device of FIGS. 8A and 8B comprising means for aligning the handle and the terminal body; FIG. 11 is a perspective view of an alternative embodiment of FIGS. 6A and 6B in which the handle comprises two articulated elements; in rotation with respect to each other, FIG. 12 is a perspective view of a control device of FIGS. 6A and 6B including a tracking system according to a first exemplary embodiment; FIG. 13 is a schematic perspective view of the control device of FIGS. 3A and 3B with a variant of the tracking system of FIG. 12; FIG. 14 is a schematic perspective view of the control device of FIGS. 8A and 8B including a second example of a tracking system; FIG. 15 is a perspective view. schematic of the control device of FIGS. 5A and 5B comprising a variant of the tracking system of FIG. 14; FIG. 16 is a perspective view of a control device according to a second embodiment comprising temporary securing means, FIG. 17 is a perspective view of a control device according to the second embodiment comprising another example of temporary fastening means, FIG. 18 is a perspective view of a control device according to the second embodiment comprising another example of temporary securing means; and FIG. 19 is a perspective view of a control device comprising a hybrid robot. at 6 degrees of freedom, - Figure 20 is a perspective view of a control device comprising a parallel robot with 3 degrees of freedom, - Figures 21 and 22 are perspective views and partial section of a device. control system comprising a parallel robot with 2 degrees of freedom, - Figures 23 and 24 are perspective views and partial section of a first example of a control device according to a third embodiment comprising a deformable contact area, - FIG. 25 is a perspective view of a variant of the device of FIGS. 23 and 24; FIG. 26 is a partial sectional view of a second example of a control device according to FIG. In this embodiment, FIGS. 27 and 28 are perspective and detail views of a control device according to the third embodiment comprising a parallel robot, FIG. 29 is a flowchart illustrating the operating principle of the present invention. FIG. 'invention. DETAILED DESCRIPTION OF PARTICULAR EMBODIMENTS The control device according to the invention comprises an element that is manipulated directly by the user, this element is generally designated "handle". This handle is the handle of a robot that can be a master arm, a haptic interface or a collaborative robot called "cobot". Sensors located on this robot can measure the movements of the handle and / or the forces applied to it. These measurements are transmitted to the controller of the robot which will calculate the commands in position or in force to be applied on the various axes of the robot to follow the movements of the user and / or apply a force feedback function of the interactions between the device that the pilot robot and its environment and / or configuration of the robot and the handle. The controlled device may be for example a slave robot in the case of teleoperation. In general, the slave arm, advantageously equipped with a gripper, for example a clamp, is controlled to follow the movements of the master arm while the master arm is controlled to follow those of the slave. We then speak of bilateral coupling in position, well known to those skilled in the art and which will not be detailed here. Other modes of coupling are also possible, which will not be detailed either. When the slave robot is in free space, it follows the movements of the master arm. The master arm is then moved only by the movements of the user. It is said that he himself is in free space. When the slave robot and in particular its gripper comes into contact with their environment, the slave robot is blocked (or at least its movements are forced). The master robot, whose position is enslaved to that of the slave, is then also blocked (or at least its movements are also constrained). It is said that he is in contact. The operator can apply forces on the handle without it moves freely. These are the efforts he feels. We talk about the return of effort. The controlled device can still be an avatar of the handle of the haptic interface in Virtual Reality. The operation is similar to that observed in teleoperation. The avatar is piloted to follow the movements of the handle of the haptic interface while the haptic interface is piloted so that its handle follows those of the avatar. Here, it is also advantageous to use a bilateral coupling in position, or any other mode of coupling. When the avatar is in free space, he follows the movements of the handle. It is said then that it is in free space. When the avatar comes into contact with his environment, he is blocked (or at least his movements are forced). The haptic interface, whose position is enslaved to that of the avatar, also has constrained movements. It is said that she is in contact. Such a device can also be used as a collaborative robot or cobot. In this case the robot is equipped both with a handle allowing the operator to manipulate it and an effector, for example a clamp carrying a tool, to act on the environment. The handle and the effector may both be at the terminal member of the cobot or be arranged on separate bodies of the cobot. When the effector moves in free space and the assistance of the cobot is not activated, the position of the cobot is imposed by the operator. We will say by analogy with the previous cases that it is in free space. On the other hand, if the effector or the object which it carries comes into contact with the environment, the movements of the cobot are constrained, therefore those of the handle are also constrained. We will say by analogy with the previous cases that she is in contact. In the same way, if we engage assistance based eg on the position of the cobot or the support on some buttons, these assistance, which may be for example exclusion zones or guidance along trajectories data, will constrain the movements of the handle. It will also be said that the latter is "in contact". It should be noted that the assistance and guidance functions can also be implemented on the master arms and the haptic interfaces. It is also said that these devices are in contact when these audiences constrain the movements of their handle. In Figure 1, we can see a schematic representation of the principle of the invention.
[0009] The control device comprises a handle 1 intended to be handled by the user, a robot 2 provided with a contact zone 402 intended to come into contact with the handle 1, measuring means 3 of the relative configuration of the handle 1 and the contact zone 402, that is to say measuring the position and / or orientation of the handle relative to the contact zone, and control means 5 incorporating the control laws managing the tracking without contact, contacting the robot and the handle at the contact zone and the force return once the robot and the handle in contact. As mentioned above, the control device can be associated with a simulation in virtual reality, with a remote-controlled robot, or with a cobotic assistance mode management device, referenced here in a generic manner, and whose information are used by the controller to manage the contacting of the robot and the handle. In this document, the same reference signs will be used to designate elements with a similar function. In addition, some elements not visible in the drawings, and therefore not shown for the sake of clarity, are nevertheless designated by a numerical reference for ease of explanation. We will now describe a first embodiment of the control device according to the invention.
[0010] FIG. 2 shows a first exemplary embodiment of a control device according to a first embodiment, and in FIGS. 3A and 3B detailed views of the device of FIG. 2 can be seen. FIG. 2, the control device can be seen without the controller.
[0011] In the example shown, the robot 2, also designated R1, has a series structure. It comprises a base 200 which can be fixed or mobile. In the case where the base 200 is movable, means for measuring its movements are provided. Moving bodies 201, 202, 203, 204, 205 and 206 are articulated on the base along a series kinematic chain. The body 201 is rotatable about an axis A1 with respect to the base 200. Its movements can be controlled around the axis A1 by the actuator M1 fixed on the base 200 and equipped with a position sensor Cl via the reducer formed by the driving pulleys P11 and P12 receiving receiver to which is connected the body 201. The body 202 is rotatable about an axis A2 relative to the body 201. Its movements can be controlled around the axis A2 by the actuator M2 fixed to the body 201 and equipped with a position sensor C2 via the reducer composed of the drive pulleys P21 (not visible) and P22 receiver to which is connected the body 202. A rod 207 is rotatable about an axis A3, relative to the body 201. In the example shown, the axis A3 coincides with the axis A2. Its movements can be controlled around this axis by an actuator M3 (not visible) fixed on the body 201 and equipped with a position sensor C3 (not visible) via the reducer composed of driving pulleys P31 (not visible) and P32 receiver to which is connected a body 207. The body 203 is rotatable relative to the body 202 about an axis parallel to the axis A2. Its movements are controlled by the motor M3 via the parallelogram mechanism formed of the bodies 202 and 203, the rod 207 and a rod 208. This device is known to those skilled in the art and will not be detailed. A body 204 is rotatable relative to the body 203 about an axis A4. Its movements can be controlled around the axis A4 by the actuator M4 fixed on the body 203 and equipped with a position sensor C4 via the reducer composed of the driving pulleys P41 and receiver P42 to which the body 204 is connected. body 205 is rotatable relative to the body 204 about a non-parallel axis A5 and advantageously concurrent and perpendicular to the axis A4. Its movements can be controlled around this axis by the actuator M5 fixed to the body 204 and equipped with a position sensor C5 via the reducer composed of the drive pulleys P51 and P52 receiver to which is connected the body 205. A body 206 is rotatable relative to the body 205 about an axis A6 non-parallel and advantageously concurrent and perpendicular to the axis A5 and concurrent with the axis A4. Its movements can be controlled around this axis by the actuator M6 fixed on the body 205 and equipped with a position sensor C6 via the reducer composed of driving pulleys P61 (not visible) and receiver P62 to which is connected the body 206 The contact zone 402 is located on the body 206.
[0012] The contact zone 402 is intended to be displaced as a function of the movements of the handle 1. The motors M1 to M6, in association with the sensors C1 to C6 and with the gearboxes P11-P12 to P61-P62 make it possible to control the position of the terminal body 206 of the robot where the contact zone 402 is located, especially when the operator moves in free space, and to guide or oppose the movements of the user, particularly when the user puts the handle in contact with 1 with the contact zone 402 or moves the handle to the contact. These motors, sensors and reducers can be of any suitable type. The motors can thus advantageously be DC electric motors with no iron rotor or brushless motors, but also and without limitation conventional DC motors, shape memory alloys, piezoelectric actuators, pneumatic actuators or hydraulic. Alternatively, on one or more axes, brakes may be used instead of all or part of the engines, these brakes may be including, but not limited to, disc brakes, powder brakes, or magnetorheological or electrorheological fluid brakes. . In the case where on one or more axes of the brakes are implemented, the device can only oppose the movements of the user and can not act on him actively. In another variant, hybrid actuators combining a motor and a brake of all types presented previously or others may be used. It is also possible to alternatively use on one or more axes antagonistic actuators and / or variable stiffness devices of the "series elastic actuators" or "parallel elastic actuators" type. The reducers, shown here schematically, may advantageously be cable capstans but they could also be non-exhaustive single or epicyclic gear reducers, one or more stages, gearboxes of the "Harmonic Drive" type or reducers ball screw. Alternatively, non-reversible gearheads such as worm gearboxes could be used. In all cases and more particularly in the case of the use of motors and / or gearboxes with low efficiency and / or having significant friction or little or no reversible, could advantageously be used at the level of the engines, at the joints robot or at its base or end of the force sensors whose signals would be used to compensate for these defects and make the robot reversible and / or more transparent.
[0013] The sensors may be of any suitable type, in particular and without limitation optical encoders, Hall effect sensors, potentiometers or magneto-optical encoders. These sensors can be absolute (multi-turns) or relative. In particular, in FIG. 2, the sensors are represented on the motors. All or part of them could also be placed on the joints of the robot. One could still have on one or more axes sensors on both engines and joints. It will be noted that in FIG. 2 and the other figures described, the kinematic connections are represented schematically. These could advantageously be achieved by means of ball bearings, smooth bearings, magnetic bearings or any other solution known to those skilled in the art. In the same way, the links are represented in a simplified manner overhanging. It could be advantageous to make clevis connections, that is to say with a recovery of the forces on each side of the link without departing from the scope of the invention, in particular for the rotational guidance of the pulleys of the reducers of which the efforts could advantageously be taken up by bearings or bearings on the side of the pulleys opposite the motors. These elements are known to those skilled in the art and are therefore neither represented nor explained. The reducers are also schematically represented. Gear teeth or capstan cables are not shown for the sake of clarity of the figures. In the case of the use of capstans, it would also be advantageous to machine a helical profile on the pulleys and to provide guiding and tensioning systems for the cables. These elements are known and will not be detailed here. Moreover, in the figures, the different bodies of the robots and the handles are represented in one-piece fashion. It is understood that this representation is only schematic. It is intended to facilitate the reading of the figures. In practice, these parts would preferably be formed of several elements assembled together. In FIGS. 3A and 3B, the handle and the contact zone 402 can be seen in detail according to a first embodiment of the first embodiment.
[0014] The handle comprises a gripping sleeve 101 intended to be handled by the user and a zone intended to come into contact with the contact zone 402 carried by the end body 206 of the robot 2. In the example shown, the handle in the form of a stylet having a longitudinal axis X and whose longitudinal end 401, designated "contact end 401", is intended to come into contact with the contact zone 402. The contact zone 402 according to FIG. invention is formed by the inner surface of a cavity 403 in which is intended to penetrate the contact end 401.
[0015] In the first embodiment, the handle 1 is completely independent of the robot, it can be spaced from the contact area 402 of the desired distance by the user in the direction of the axis X. The contact end 401 and the contact area 402 preferably has similar shapes to a scale factor. In the example shown, the contact end has a cylindrical portion terminated by a hemisphere and the interior of the cavity is delimited by a cylinder portion closed at one end by a hemisphere. Thus the device will have a homogeneous behavior in all directions since in a nominal configuration the distance to travel before the contact is the same in all directions. The distance separating the zones 401 and 402 is advantageously chosen to be sufficiently large so that the robot is never in contact with the handle in free space, whatever the movements of the user, and small enough so that the contact takes place quickly when desired. It will be understood that the absence of contact regardless of the movements of the user is to be considered relative to a given range of movements depending on the use. For example, when simulating or controlling the insertion of a part into another, it often appears successive contacts on each side of the part that is inserted. Thanks to the invention, by choosing a sufficiently small distance, it is ensured that the contact zone 402 can come quickly from one side to the other of the end 401, and these insertion forces are restored efficiently. In the example shown, the handle 1 is also equipped with buttons 102, for example three in number and serving for example to launch particular modes of operation, such as for example the seizure of an object, the offset or the activation of a virtual guide. The handle could still be equipped with a dead man type device. To measure the state of the buttons and the dead man, the handle could be connected to the controller of the robot by wires. It could still be equipped with a specific electronic circuit with a wireless transmission system, for example type Wifi or Bluetooth, and batteries or batteries, to send this information to the controller. These elements are known to those skilled in the art and will not be presented in detail here. The measuring means 3 making it possible to know at any moment the relative position of the handle 1 with respect to the terminal body 206, and therefore the relative position of the contact end 401 with respect to the contact zone 402, will be described by the after. The knowledge of this relative position makes it possible to control the device by means of the controller so that the robot remains at a distance from the handle in free space in order to avoid contact or, conversely, comes into contact with it at the time and at the desired locations of the contact end 401 and contact zone 402, or finally that they remain in contact. The handle of the device of FIGS. 3A and 3B being of revolution, the motor M6 and the sensor C6 could be omitted.
[0016] The operating principle of the system incorporating the control device of FIGS. 3A and 3B will now be described using the flow chart of FIG. 29. The user grasps the handle 1. The sensors C of the robot make it possible to know at at any moment the absolute configuration of the terminal body 206 in space, designated CONF2. This information is designated INF2. The measuring means 3 measure the actual configuration of the handle, designated CONF1, and make it possible to know the absolute configuration of the handle in the space and the relative configuration of the handle relative to the robot. This information is designated respectively INF1 and INF3. In the example shown in FIG. 29, the measuring means 3 make it possible to measure the relative configuration of the handle relative to the robot, which is particularly the case when using so-called "internal" measuring means and which will be described later. The absolute configuration of the handle is then obtained by combining this information with the absolute position information of the end of the robot. It is understood that the measuring means 3 could also, without departing from the scope of the invention, to measure the absolute configuration of the handle in space, which is particularly the case when using means of so-called "external" measure and will be described later. The relative configuration of the handle relative to the robot is in this case obtained by combining this information with the absolute position information of the end of the robot.
[0017] This information is transmitted to the slave robot B or to the simulation software B in the case of a haptic interface or to the assistance management device B in the case of a cobot. Furthermore, the simulation software or the sensors of the slave robot or the cobot make it possible to know at any moment the absolute configuration of the avatar or the slave robot or the effector of the cobot, this information is designated INF4, and its distance surrounding real or virtual objects, this information is designated INF5. This information is sent to a corrector R belonging to the controller of the robot that combines them and processes them to control the motors M of the robot which, according to the model E of the robot, make it possible to control the actual configuration CONF2 of the terminal body 206, and the simulation software or the motors of the slave robot or the cobot make it possible to modify the configuration, designated CONF4, of the avatar or the slave robot or the effector of the cobot respectively. The device can have three operating states: - A free space operating state: when the avatar or the slave robot or the cobot are at a distance from their environment and their movement is not constrained by an audience, the system is said in free space. The configuration of the controlled device is then controlled on that of the handle 1 and that of the robot 2 on that of the controlled device. Thus the robot 2 follows the movements of the handle imposed by the user, to the dynamics near these systems. The contact end 401 and the contact area 402 remain at a distance from each other. - The free-contact space transition: when the avatar or the slave robot or the cobot come into contact with their environment and / or when their movement is activated, their movement is restricted or blocked. The robot 2, which is then always enslaved to follow the movements of the controlled device, will also see its restricted movement or be blocked. The handle 1 still manipulated by the user and which is, for its part, free will then approach the robot and the contact end 401 and the contact area 402 will come into contact. This transition is even faster and thus the contact all the more realistic for tasks such as insertions requiring successive successive contacts that the distance between the surfaces 401 and 402 is low. The distance is however sufficient so that they do not come into contact in free space. Note that since the controlled device is blocked in contact with its environment, the movement of the handle to come into contact with the robot can be seen as a penetration into the environment or an overtaking of the handle compared to the avatar or slave robot or cobot. This exceeding is the lower the distance between the contact end 401 and the contact area 402 is low. - Operation in contact: once the handle in contact with the terminal body of the robot, it can be controlled in position or effort. In the case of a position control, its configuration is slaved to that of the slave. This one being blocked, the robot 2 is also blocked, as well as the handle since this one is in contact with the robot. In the case of a control in effort, the robot is directly enslaved to apply on the handle the same efforts that those applied on the avatar and provided by the software of simulation or on the robot, measured by its sensors and provided by the slave controller. In both cases the user feels a return of effort to the contact.
[0018] The second state (free-contact space transition) is also the one in which the system is located during contact-free space transitions: when the user moves the handle so as to move the avatar or the slave robot in a direction opposite to their environment, the avatar or the slave robot will first stay in contact with his environment as the passing of the handle relative to him has not returned to zero since the avatar or the slave is always enslaved in position on the handle which is seen by him as being located inside the environment. Then the avatar or slave will follow the movements of the handle and will no longer be in contact with his environment. The system is then found in free space. In order for the time shift between the movement of the handle and that of the robot to be small, a small distance between the surfaces 401 and 402 is required.
[0019] In the example shown in FIG. 29, the corrector R uses the information INF1, INF2, INF4 and INF5. It could also use other combinations of information INF1 to INF5 without departing from the scope of the invention. Any other type of control of the robot and / or the controlled device could also be used, provided that these three operating states can be managed. It would be for example possible to introduce amplification factors in position and / or effort between the handle and the controlled device. One could also use a speed control, especially in free space, or a command switching between position and speed control according to the movements of the handle. One could still constrain certain movements, for example using virtual guides. All these elements are known and will not be detailed. The robot can be controlled in position in free space and in contact. It can also be controlled in position or speed in free space and in contact force. In this case a switch will be made between the control in position in free space and during transitions and control in contact force. Since these control modes are very different, instabilities may occur if the switching does not take place exactly when the surfaces 401 and 402 come into contact due to errors or inaccuracies in the measurement of the relative configuration of the position. of the handle and the terminal body of the robot. A contact detection device can then advantageously be used between the handle and the robot, this information making it possible to trigger the transition even if the difference measured on their configurations is not zero, in order to avoid the appearance of instabilities. when switching from one control mode to another. Such a contact detection device will be described in more detail below in connection with FIG. 14.
[0020] Thanks to the invention, the force return applied by the robot to the handle is multidirectional due to the enveloping shape of the contact zone. The contact zone can apply a force opposing the movement of the handle in several directions.
[0021] This embodiment also allows bilateral force returns in directions substantially transverse to the axis X of the handle. In Figures 4A and 4B, we can see a variant of the control device of the first embodiment wherein it is the shape of the contact end and that of the contact area that differ. In this variant, the contact end 401 has a frustoconical shape and the cavity 403 has a corresponding frustoconical shape of the same dimensions. Thus and contrary to the case illustrated by FIGS. 3A and 3B, the handle and the end body 206 are in contact all around the contact end 401 and the contact zone 402 after they have been brought into contact. In this case their relative distance is zero, which makes it possible to simulate insertions even more easily. This first embodiment in which the handle is partially free to move relative to the terminal body has the advantage of allowing very easy tool change. Just take out the handle used for example after pressing one of the buttons to indicate to the controller that the tool will be changed, then enter another tool and put the contact end 401 of this new tool in glance or in contact with the contact zone 402, and finally to indicate to the system that one is ready to use the new tool, for example by pressing a command button. The different tools will advantageously be equipped with recognition means, such as, for example and non-exhaustively, a bar code, a flashcode, a bubble code, an active or passive RFID tag, a local color code, or any other means of recognition. , and the robot will advantageously be equipped with a device for reading these elements. These devices and their reading means are known to those skilled in the art and are not detailed here. The information on the type of handle used is designated INF6 in Figure 29. It can be used to automatically update the models of the robot, for example to accommodate handles of different shapes and / or lengths, and to ensure that the force feedback is always correct in the hand of the user regardless of the handle used.
[0022] It will be understood that it could also be only the input area 101 or the input area 101 and the buttons 102 which are interchangeable. In this case, these elements would be advantageously separable from the end 401 and provided with the recognition means presented above. Of course it would also be possible to change the input area 101 or all the handle 1 with the other examples or variants or embodiments. It is also understood that it could also be the contact end 401 which forms a cavity in which the contact area 402 is inserted as illustrated in FIG. 7A.
[0023] In FIGS. 5A and 5B, a second exemplary embodiment of a control device according to the first embodiment of the invention can be seen. This example differs from the first example in that the relative displacement between the handle and the terminal body is limited in all directions (with the exception of rotation around the X axis in the example of FIGS. 5A and 5B).
[0024] The handle of Figs. 5A and 5B still has a stylet shape and has a spherical shaped contact end 401 received in a corresponding spherical shaped cavity. The contact zone 402 is therefore also spherical. The outer diameter of the sphere 401 and the inner diameter of the sphere 402 are chosen so as to allow relative movement between the handle and the terminal body to allow transparent operation in free space. More particularly, the handle comprises a gripping sleeve 101 and a spherical contact end 401 connected to the handle by a thinned area 103. The cavity 403 has an opening 209 of diameter large enough for the passage of the thinned zone 103 and sufficiently small for preventing the contact end 401 from escaping from the cavity 403 so as to form retaining means for the contact end 401. The diameter of the spherical end 401 with respect to the diameter of the cavity 403 is chosen according to the desired operation in free space. The more we wish a possibility of relative displacement between the contact end 401 and the important contact area 402, the greater the difference in diameter will be and conversely, if it is desired a possibility of relative displacement between the contact end 401 and the 402 weak contact area, the difference in diameter will be small. As for the device of FIGS. 3A and 3B, the handle being of revolution, the motor M6 and the sensor C6 can be omitted.
[0025] The operation of the second embodiment of Figs. 5A and 5B is similar to that of the controller of Figs. 3A and 3B. It allows multidirectional effort feedback. In addition, it allows, in a very advantageous manner with respect to the first embodiment, a bilateral force return in all directions in translation since the contact end of the handle can not escape from the cavity 403. robot is then able to apply a force feedback along the X axis in both directions, which do not allow the devices of Figures 3A and 3B and 4A and 4B. This robot can be used to apply forces only in translation. In this case the motors M4 to M6 will be used to orient the body 206 in the same orientation as the stylet 1. It may also be used to apply forces in translation and following up to two degrees of freedom in rotation (taking into account its geometry, this robot can not apply forces in rotation around the axis X). In this case, the motors M4 to M6 will be used to apply couples to the stylet 1 via the contact forces on the one hand between the end 401 and the zone 402 and on the other hand between the thinned zone 103 and 209. In FIGS. 6A and 6B, we can see an alternative embodiment of the second embodiment in which the contact end 401 has a rectangular parallelepiped shape received in a cavity having a corresponding shape. The handle 101 of the handle is connected by a thinned portion 103 to a face of the contact end. The operation is similar to that of the devices of FIGS. 3A to 5B. It has the advantage of offering a bilateral force return in all directions both in translation and in rotation. It allows with respect to the device of Figures 5A and 5B, once the contact end and the contact area in contact, to apply a force on the hand of the user or to resist an effort of the operator in all directions, both in translation and in rotation. The contact can take place on the faces, but it can also take place on a combination of edges or corners.
[0026] As before, this robot can be used to apply efforts only in translation. In this case, the motors M4 to M6 will be used to orient the body 206 in the same orientation as the stylet 1. It may also be used to apply forces in translation and following up to three degrees of freedom in rotation. In this case, the motors M4 to M6 will be used to apply torques on the stylet 1 via the contact forces between the end 401 and the zone 402. In FIG. 7A, a variant of the device of the figures can be seen. 6A and 6B, wherein it is the contact end 401 which includes the contact zone 402. The end body 206 has a thinned zone 210 connecting its upstream portion to the contact zone 402 and the cavity 403 comprises a opening 104 formed in the handle 1 of diameter large enough for the passage of the thinned area 210 and small enough to prevent the contact area 402 from escaping the cavity 403. The operation of the device of Figure 7A is similar to that of the device of FIGS. 6A and 6B.
[0027] In FIG. 7B, another variant of the second exemplary embodiment of a control device according to the first embodiment of the invention combining certain elements of the device of FIGS. 5A and 5B and other elements of the device of FIGS. FIGS. 6A and 6B, and in which the contact end 401 has a spherical shape and the cavity 403 and the contact zone 402 have a rectangular parallelepiped shape, advantageously cubic so that the behavior of the system is the same in all directions . Thus, the contact of the sphere on each face of the cube will be punctual and easier to manage than on the device of FIGS. 6A and 6B. In FIGS. 8A and 8B, another alternative to the device of FIGS. 6A and 6B can be seen, in which the contact end 401 is of cubic shape, the cavity 403 has a corresponding cubic shape and the handle is connected to the contact end by the thinned portion 103 at a corner of the cube. The operation of this device is similar to that of the device of FIGS. 6A and 6B.
[0028] It will be understood that the forms illustrated in FIGS. 3A to 8B are given by way of nonlimiting examples and are represented in a stylized manner. Any other form of the contact areas is within the scope of the invention, provided that the contact can be bilateral in at least one direction of space (in translation and / or in rotation). In the examples described in FIGS. 3A to 7A and 8A and 8B, the contact end and the contact area have corresponding shapes. It is also possible that the contact end and the contact area are not of corresponding shapes, as in the example of FIG. 7B. In addition, it will be understood that the contact end and the contact area may have different sizes or the same size, as for example in the variant of Figures 4A and 4B. One could also provide end and contact zone of identical size on a portion of their surface and operating in certain directions as the variant of Figures 4A and 4B and ends and contact zone of different sizes in other parts of their surface and operating in other directions like the other variants of the device. Advantageously and as is the case for the devices of FIGS. 3A to 8B, the contact end and the contact area occupy an area which is approximately around the intersection of the axes A4, A5 and A6. This arrangement has the advantage of being able to easily decouple the forces generated in translation and in rotation at the contact end and the contact area. It should be noted, however, that, in order to be able to apply, for example, a pure force to the gripping zone 101, it is necessary to apply on the contact end and the contact zone at the same time a force and a moment. In FIGS. 9A and 9B, another variant embodiment of the second exemplary embodiment can be seen. The device of FIGS. 9A and 9B differs from those already described in that the handle is such that it lies entirely inside the cavity 403. In the representation of FIGS. 9A and 9B, the terminal body 206 is represented as a monobloc element, but it will be understood that the terminal body could in practice be machined in several pieces assembled around the contact end of the handle. In this variant, the handle or the gripping zone of the handle 1 is arranged so that its center is close to the intersection of the axes A4, A5 and A6. Thus the force return in translation and rotation on the hand is decoupled. In the example shown, the contact end is cubic and is received in a cubic cavity. The handle extends between two vertices of the cube. Thus the contact end and the cavity have an opening sufficient to introduce one or more fingers, a hand or both hands and handle the handle. As in the devices described above, the handle 101 may include control buttons 102.
[0029] It will be understood that this arrangement of the handle handle within the volume defined by the contact zone can be applied to all variants of the first and second embodiments. For example, the contact zone and the contact end could be spherical or frustoconical. In the examples of devices described above and which comprise a robot such as that of Figure 2, the axes Al to A6 are motorized. Under these conditions, it is possible to apply a force on the handle so on the hand of the user or to oppose its movements in certain directions or all directions depending on the case, in translation and in rotation. There is therefore in this case a device having up to 6 degrees of freedom with force feedback. It would also be possible not to motorize the A4 to A6 axes. In this case the device would have 3 degrees of freedom with force feedback in translation, the rotations being free. The terminal body of the robot can then simply follow the rotational movements of the handle by driving by it when the handle is in contact with the body 206. However, in case of a change of direction in rotation, the user then feels the successive contacts of the surface 401 on each side of the surface 402, which can affect the impression of moving in free space. In order to further improve the free-space displacement printing, a 6 degrees of freedom system can be implemented and in which the motors M4 to M6 are used to control the terminal body 206 so that its orientation follows that of the handle. The axes A4, A5 and A6 can then be motorized with stepping motors so that the body 206 follows the movements of the handle. These engines have the advantages of being generally lighter, more compact and easier to control than the torque-controlled engines. Alternatively and as shown in Fig. 10, passive systems may be provided to automatically align the handle and the terminal body of the robot in orientation. In the example shown, the guidance system SG comprises one or more magnets 105 on the contact end 401, one pole, for example the north pole, is located opposite the contact zone 402 and one or more magnets 211 on the contact zone 402, whose opposite pole to that of the pole of the magnets 105 of the contact zone opposite, here for example the south pole, is located opposite the contact end 401. Thus the poles of the magnets 105, 211 will automatically attract and align the contact end 401 and the contact area 402, and thus will align the handle and the terminal body of the robot. The magnets 105, 211 are advantageously placed in housings machined in the hollow parts 1 and 206 so that they do not exceed the surfaces of the contact areas 401 and 402 and they do not interfere with the contacting of these areas. Alternatively, the magnets 105, 211 could be located on the handle 1 and on the body 206 outside the contact end 401 and the contact area 402. For example, the cavity may comprise on the edge of its opening magnets and the handle could comprise a radially extending element facing the edge of the opening of the cavity and carrying magnets. The magnets of the terminal body and / or of the handle could be replaced by electromagnets, which would make it possible to control the alignment, for example as a function of the distance between the contact end 401 and the contact zone 402. , although the axes A4, A5 and A6 are not motorized in this case, they could be equipped with position sensors to know the orientation of the terminal body. This embodiment of a self-alignment system is given for information only and is not limiting. It would thus be possible to use a number of different magnets or electromagnets on the contact end 401 and on the contact zone 402. These magnets or electromagnets could still be arranged differently and not necessarily opposite each other. . Any other device fulfilling the same function could still be used. One can for example think of inserting between the contact end 401 and the contact zone 402 a very flexible foam having almost no resistance to contacting these surfaces but still allowing to push the body 206 into space free. It will be understood that these solutions could be applied to all modes and to all variants.
[0030] In Figure 11, we can see an alternative embodiment of the shape of the handle. This variant is applied to the device of FIGS. 6A and 6B, but it will be understood that it can be applied to all devices. This variant forms a force feedback clamp. The handle has been replaced by two bodies la and lb movable in rotation around the axis AP1. Each of the bodies 1a and 1b has a gripping zone, designated respectively 101a and 101b. The body la is provided with a contact end (not visible) housed in a cavity and able to come into contact with a contact zone (not visible). The additional degree of freedom around the axis AP1 may advantageously be motorized with the aid of an MP1 motor provided with a position sensor CP1, which can be of any of the types described above. Alternatively the two bodies la and lb could be mounted in translation relative to each other. Note that for this variant, the motor and the encoder can be connected to the controller via flying electrical cables or running along the robot. The handle can also be advantageously equipped with a rechargeable battery or batteries for powering the engine MP1 and a card equipped with a wireless transmission to receive the orders of the controller and return the information of the position sensor. This variant of the handle can be used in all the examples of devices described.
[0031] It will be understood that one could also equip each body la and lb of a contact end, each of which is facing a contact zone, without departing from the scope of the invention. In this case it would not be necessary to motorize the handle 1 and the motor MP1 and the encoder CP1 could be omitted. The contact zones could be on the end bodies of two different robots or on the end bodies of a single tree-chain robot. It will also be understood that the pen or scissor forms of the handle 1 are only given as examples. The handle 1 could also without departing from the scope of the invention take any other form suitable for gripping and ergonomic manipulation. It may for example and non-limitatively be in the form of a handle for PTO, a joystick handle, a tee, a ball, a mouse, a pommel, a a steering wheel or lever. It can also have a deformable hollow shape or not, such as a dice or a ring in which one can insert one or more fingers or the palm or the whole hand. It can still be deformable as for example a pair of tweezers. It will be understood that these solutions could be applied to all modes and to all variants. Means for measuring the configuration of the handle, also called tracking system will now be described. The aim of the tracking system is to measure either the absolute configuration of the handle in space or the relative configuration of the handle 1 with respect to the robot 2 and, in particular, with respect to the terminal body 206. This tracking system , in the case where it measures the absolute configuration of the handle, can also measure the absolute configuration of the terminal body 206 of the robot, configuration also known by the sensors C1 to C6 of the robot. This information (absolute configuration of the handle and robot in space and relative configuration of the handle relative to the robot) are used by the controller for the coupling of the master arm, the haptic interface or the cobot integrating a device according to the present invention to a slave arm or a simulation in virtual reality or for the management of modes of assistance.
[0032] In Figure 12, we can see a first embodiment of the tracking system that can be implemented in the present invention shown schematically, the system being described as "external". The system includes a camera 31 arranged to display the handle and the terminal body. The camera can operate in any band of the light spectrum, especially in the visible light or infrared range. The image obtained by this camera is processed to extract the position and orientation information of the handle. This camera can also advantageously be used to measure at the same time the position and the orientation of the terminal body 206 of the robot. This system has the advantage of requiring no additional equipment on the handle and the robot. It can advantageously be provided that the handle and the terminal body 206 comprise sharp edges 110, 220 more easily used by the image processing algorithms than the rounded shapes. These edges are for example made by machining.
[0033] Preferably, the camera is associated with a lighting device 32 reinforcing the contrast of the image in the measurement spectrum of the camera, the illumination provided by the lighting device being for example infrared. This lighting device may be separate from the camera as shown in Figure 12 or integrated around the lens.
[0034] The handle and the body 206 may advantageously be illuminated with a structured light to facilitate measurements. It can be planned to use several cameras and / or lighting devices arranged around the robot and the handle, to make 3D measurements, to have a better resolution and / or to avoid blind spots and visual occlusions. .
[0035] The images thus obtained are processed by imaging techniques and associated image processing algorithms well known to those skilled in the art and which will not be detailed here. In Figure 13, we can see an alternative embodiment of the system of Figure 12, wherein targets 301 and 302 are integrated in the handle 1 and the terminal body 206 of the robot. These targets can be passive, they are then advantageously retro-reflective in the spectrum of the lighting device 32. Alternatively, they can be active, ensuring their own lighting, for example in the field of infrared. Such active targets may advantageously be controlled to send each a specific signal, for example at a given frequency, so as to facilitate their identification and their distinction with respect to other targets. In the case where active targets are provided on the handle, the handle may advantageously include the batteries or batteries necessary for their power supply. Such targets are easier to locate and make it easier to measure the system configuration. It is understood that one could integrate targets only on the handle or on the body 206. Here we could also use several cameras to perform the measurements. It can also provide to use passive targets and active targets, for example passive targets on the handle thus requiring no power and active targets on the robot. In addition, the targets may have different shapes and sizes to help distinguish them, especially in the case of passive targets. Such targets may still be of different colors, or have geometric patterns to distinguish them more easily. With the tracking systems as shown schematically in Figures 12 and 13, we obtain the positions and absolute orientations of the handle and the terminal body of the robot, which can easily be deduced the relative configuration of the handle relative to the robot. It is recalled that the positions and absolute orientations of the terminal body of the robot can also be obtained thanks to the sensors of the robot.
[0036] It is therefore not necessarily useful to measure them with the tracking system 3 and we can measure only the configuration of the handle that will be the only one to be illuminated or provided with targets. The tracking systems illustrated in Figures 12 and 13 are given only as examples. In general, any non-contact measuring system could be used, for example and in a non-exhaustive manner: motion capture systems with or without targets such as ART Track or Vicon Bonita devices, electromagnetic or ultrasonic sensors such as sensors Polhemus, Leica Eye Tracker laser trackers, field of view or flight time cameras such as Kinect® or Leap Motion®. FIG. 14 schematically shows a second embodiment of a tracking system adapted to the present invention. This is called an "internal tracking system". In this embodiment, the handle 1 and the terminal body 206 of the robot integrate non-contact sensors to know the relative configuration of the handle relative to the robot. The absolute configuration of the terminal body of the robot being known using a geometric model using input values of the robot sensors, the absolute configuration of the handle is easily deduced. In the representation of FIG. 14, the handle is equipped at the contact zone 401 with emitters 33 which may be, for example, light-emitting diodes (LEDs) emitting in the infrared range and powered by batteries or batteries. advantageously integrated in the handle. These LEDs are advantageously evenly distributed around the periphery of the contact end 401. In the embodiment shown in which the contact end is cubic, an LED is provided on each of the faces. As a variant, several LEDs could be provided per face or some faces could not be equipped with LEDs, these being concentrated on only some parts of the contact end 401. The contact zone 402 is itself equipped with in comparison with the LEDs 33, sensors 34 sensitive to the distance to the LEDs and / or changes of orientation of the LEDs facing each other, for example phototransistors. In the example shown, there are six in number (some not visible) each disposed on one of the faces of the zone 402. The number of sensors 34 and their arrangement depend on the number of LEDs and their distribution on the end. of contact. Preferably, the LEDs 33 and the sensors 34 are advantageously integrated in recesses machined in the contact end 401 and the contact zone 402 so as not to protrude from their surface and not to impede the phase of displacement. in free space and bringing these surfaces into contact. The combination of the measurements of the different couples LED-sensor makes it possible to calculate the relative configuration of the handle relative to the terminal body 206. It will be understood that the sensors 34 could be on the opposite side on the handle and the LEDs 33 on the body terminal 206. There could still be some sensors on the handle and others on the body 206 and some LEDs on the handle and others on the body 206. Alternatively, the phototransistors 34 could be replaced by PSD displacement sensors (Position Sensitive Detector in Anglo-Saxon terminology) linear or surface. It will be understood that there could be a different number of LEDs and sensors, some sensors such as surface PSDs, well known to those skilled in the art and whose operation will not be detailed here, which can measure movements following several directions. Alternatively also, proximeters could be used in place of LED-phototransistor sets. These components integrate on a single component a transmitter and a receiver and directly provide information on the distance of the object opposite, without the need to fix a target. In this case these proximeters could be arranged all on the handle, all on the body 206 or be distributed between the handle and the body 206.
[0037] According to another variant, it is still possible to place on the handle and on the body 206 coils traversed by a current and whose mutual inductance varies according to their distance, some coils can still be replaced by permanent magnets. In this case the magnets would be advantageously placed on the handle and the coils on the body 206.
[0038] According to another variant, conductive surfaces could be used on parts facing zones 401 and 402 so as to create a capacitor whose capacitance varies as a function of the distance to be measured.
[0039] In a general manner, the tracking system could implement any type of contactless sensor making it possible to assess the distance or proximity of an area of the handle relative to the terminal body of the robot, for example using, for example exhaustive of electromagnetic, ultrasonic or optical technologies, operating with or without a target, in particular inductive or capacitive sensors or infrared proximeters. It could also implement passive mechanical measurement systems between the handle 1 and the body 206 such as miniature puppets having adapted mobility or deformable structures having sufficient number of sensors. These devices are known and will not be detailed here. In this case, however, the transparency in free space would be reduced compared to a non-contact system. It will be understood that a tracking system combining several types of sensor is not beyond the scope of the present invention, for example accelerometers and optical sensors. In addition, whatever the sensors selected, the number of sensors used depends on the number of degrees of freedom of the system and the number of measurements that can provide each sensor. In order to improve the quality of the measurements, the number of sensors used may be greater than that strictly required. FIG. 15 shows a variant of the tracking system of FIG. 14. In this variant, the measuring devices 33-34 are arranged outside the contact end 401 and the contact zone 402. which simplifies the realization of the device. For example, the handle comprises elements 111 extending transversely to the longitudinal axis, and carrying LEDs 33 disposed opposite the contour of the opening of the cavity 403. Surface PSD sensors 34 are provided on the contour the opening of the cavity in sight of the LEDs. The elements 111 extending transversely are formed in the example shown of three arms distributed angularly in a regular manner around the axis of the handle. These components are only given by way of example and any other measuring means such as those presented above could be used. One could also use more measuring systems or arrange them differently on the handle and on the body 206.
[0040] The tracking systems described above apply to all the control devices described. It may be provided that the handle and / or the body 206 are equipped with means for detecting a contact between them. For example, and as shown in FIG. 14, it is possible to use an electrical circuit composed of a flexible wire 35, a battery or a battery 36, a current sensor 37 and contact zones and contact tips. 401 and 402 which will advantageously be covered with a thin layer of conductive material. The wire 35 flows from the conductive material of the contact end 401 to the conductive material of the contact zone 402 via the elements 36 and 37 (it is shown in dashed lines where it passes inside the handle and the body 206). Thus, when the surfaces 401 and 402 are separated, the circuit is open and no current passes into the sensor 37. On the contrary, when these surfaces are in contact, the current passes and is detected by the sensor 37. This contact information can then be used by the controller. This very simple device is given as an example. Any other means of checking the contact could be used, for example contactors, switches or pressure or force sensors arranged on the handle and / or the body 206. Alternatively, these contact detection means can be a system optical, magnetic or electromagnetic appendix, one or more contact or stress sensors such as strain gauges or a piezoelectric material, one or more sensors for moving and / or deforming a mechanical part, ... We are now going describe a second embodiment of the invention wherein means for temporarily securing the handle on the main body are provided. In Figure 16, we can see a first example of this second embodiment which is similar to the example of the first embodiment shown in Figures 4A and 4B. The contact end 401 has a frustoconical shape and the cavity 403 whose inner surface forms the contact zone 402 also has a frustoconical shape. However, in this exemplary embodiment, the apex angle of the cones defining the outer surface of the contact end and the inner surface of the contact zone are such that, when brought into contact, it is necessary to apply a some effort to separate them. The cone slope, the material pair and the surface state of the zones 401 and 402 can advantageously be chosen so that the separation of the two parts requires a given known effort. Thus below this effort the handle can be considered as integral with the robot and can be transmitted to him in all directions, both in translation and in rotation. In Figure 17, we can see an alternative embodiment of the second embodiment. In this variant, the fastening of the handle and the terminal body is not obtained by jamming two frustoconical surfaces but by means of a securing device integrated on the handle and on the body 206, this securing device being at threshold or controllable and having elements 431 and 432. The element 432 located in the bottom of the cavity 403 may for example be a magnet and the element 431 located at the free end of the contact end 401 may comprise at least a part of a metallic material. Thus when the contact end 401 and the contact zone 402 arrive in the vicinity, the elements 431 and 432 will attract and secure the handle and the body 206 until sufficient opposing forces are exerted on them. to take off the magnet 432 and the piece 431. Alternatively, the magnet could be located on the handle and the magnetic material on the body 206. We could still use two magnets whose opposite poles face each other. This securing device is a threshold device. In the case where this threshold phenomenon is not desired, it is advantageous to implement a controllable two-state system. One could for example use a system comprising a magnet 431 advantageously placed on the handle and a coil 432 placed on the body 206, so as to be easily powered. Thus, if no current is flowing in the coil, the handle and the body 206 are free to come apart while if a current flows in the coil, the handle and the body 206 are held in contact by a force generated by the interaction between the magnetic fields of the magnet and the coil. Alternatively, a magnetic suction device could be used. Such devices are known to those skilled in the art and will not be detailed here. In another variant, a controllable securing device such as that described in US2011073118 could be implemented in the present application. Figure 18 illustrates a second variant of the second embodiment of the device. In this variant, the contact end and the contact zone are parallelepipedic and several securing devices 431 and 432 are integrated on the periphery of their surface. Thus it will be possible to secure the handle 1 and the robot 2 regardless of the portion of the areas 401 and 402 in contact. It will be understood that all types of securing device described above can be applied. In a non-exhaustive manner, the following solutions of securing devices can be implemented: one of the surfaces could be smooth, the other equipped with suction cups or pneumatic vacuum systems, the two surfaces could also be provided with Velcro® strips, or at least one of them being coated with a glue or an adherent polymer. During operation of a device according to the present invention comprising a controlled fastening device, the distance information of the avatar, the slave robot or the cobot is used to its environment to control the fastening device, so as to join together the handle and the robot as the avatar, slave robot or cobot comes in contact with their environment. We will now describe examples of robots that can be implemented in the control device according to the invention. In FIG. 19, we can see a hybrid robot with 6 degrees of freedom comprising end bodies carrying a contact zone cooperating with a handle according to the invention. The robot R2 comprises two branches 2a and 2b respectively comprising bodies 200a to 208a for the branch 2a and 200b to 208b for the branch 2b. Each branch has a structure similar to the robots presented above, except that it has only 4 motors for the branch 2a and 3 motors for the branch 2b, but it could also have a different structure. The branches 2a and 2b are arranged in parallel and connected at their terminal members 206a and 206b. The body 206a is rotatable relative to the body 205a, the body 206b is rotatable relative to the body 205b and the body 206a is rotatable relative to the body 206b. The axes of these links are advantageously collinear. In the example shown, the contact zone 402 is located on the body 206a. As a variant, it could be located on the body 206b if it was the branch 2b which was equipped with 4 motors and the branch 2a which was only equipped with 3 motors. The contact zone and the handle 1 are here similar to those of FIGS. 6A and 6B. Branch 2a is equipped with motors M1a to M3a equipped with position sensors C1a to C3a. Branch 2b is equipped with M1b to M3b motors with position sensors C1b to C3b. By making it possible to move the ends of the two branches and / or to apply a force on these ends in the same direction, these motors make it possible to ensure a return of effort on 3 degrees of freedom in translation. By making it possible to move the ends of the two branches and / or to apply a force on these ends in opposite directions, they make it possible to ensure a force return over 2 degrees of freedom in rotation about axes perpendicular to the bodies 206a. and 206b. An additional motor M7a equipped with a C7A sensor is disposed on the body 205a and provides force feedback around the axis of the bodies 206a and 206b. FIG. 20 shows another example of a parallel architecture robot with 3 degrees of freedom with a "modified Delta" type force return as described in article Y. Tsumaki, H. Naruse, DN Nenchev, M. Uchiyama, Design of a compact DOF 6 haptic interface, Proc. IEEE Int. Conf. The Robotics and Automation, Leuven, Belgium, May 1998. The robot R3 has three branches 2a, 2b and 2c arranged in parallel and connecting the base 200 to the mobile platform 206. The branches 2a, respectively 2b and 2c comprise bodies mobiles 201a, 202a, 203a, 204a, 205a, respectively 201b, 202b, 203b, 204b, 205b and 201c, 202c, 203c, 204c, 205c. The force feedback is ensured by the motors M1a on the branch 2a, M1b on the branch 2b and M1c on the branch 2c, equipped with position sensors C1a, C1b and C1c (in Figure 20, the motor M1b and the sensor position C1b of branch 2b are not visible). The motors are all three fixed on the base and actuate the bodies 201a, 201b and 201c via gearboxes not referenced to not weigh down the figure. This architecture is well known to those skilled in the art and its operation will not be detailed here. This architecture makes it possible to move the platform 206 only in translation. The specific arrangement of the connections between the bodies is such that the platform 206 can not move in rotation. When the user is in free space, the robot is controlled so that the contact end and the contact area, the relative configuration of which is measured by the tracking system, do not come into contact with each other. When the user comes into contact, the controller controls the motors so that the handle comes into contact with the robot. Finally, in contact, these two elements remain in contact with each other. In the example shown in FIG. 20, the gripping area of the handle 1 advantageously has the shape of a ball that is more compact and more ergonomic than a stylet for controlling the system in translation. In addition, in this type of device with 3 degrees of freedom, the contact end of the handle 1 and the contact zone of the platform 206 are advantageously spherical in shape as those shown in FIGS. 5A and 5B. The user can thus freely rotate the handle around an axis here vertical. It can also freely rotate the handle around any horizontal axis, as long as the thinned portion 103 of the handle does not come into contact with the periphery of the opening 209 of the cavity 403. Thus, even if the user slightly changes the orientation of the handle by moving the system into free space, it will not cause contact between the handle and the body of the robot. FIGS. 21 and 22 show another example of a robot having two degrees of freedom that can be implemented in a device according to the present invention. The robot R4 comprises two branches 2a and 2b connecting a base 200 to a movable end piece 206. The branches comprise bodies 201a and 202a, respectively 201b and 202b. M1a and M1b engines equipped with C1a and C1b position sensors make it possible to apply a force on the terminal body 206 in the plane. This parallel structure with 2 degrees of freedom of the bar mechanism type is well known to those skilled in the art and its operation will not be detailed here. It is presented only as an example. Any other structure with 2 degrees of freedom, in particular series structures or parallel structures, for example parallelogram type, could also be used. In Figure 22, we can see a partial sectional view of the handle and the contact area of the device of Figure 21. The handle has generally a cylinder shape, which offers a good ergonomics for a displacement in the plane . Any other form could be used, such as a computer mouse shape. The contact end 401 of the handle 1 and the contact zone 402 of the terminal body 206 of the robot have a cylindrical shape, respectively male and female. In this example, the height of the two cylinders is the same while their diameter differs. That of the contact end 401 is slightly smaller than that of the contact area 402. Thus, any rotation of the handle is impossible, except around a vertical axis, and the user can move it only in the plane. The lower planes 411 and upper 421 of the contact zone 401 and the lower planes 412 and upper 422 of the contact zone 402 may advantageously be made of materials having little friction between them, such as for example Teflon®, in order to opposing a weak or no resistance to the relative movement of the handle relative to the terminal body in the plane during their contacting or separation. Alternatively or in combination with the implementation of materials offering low friction, one could also lubricate these surfaces to further minimize friction. Alternatively or in combination with the means mentioned above, one could also insert beads between these surfaces. Alternatively also the contact end 401 and the contact area 402 could have a parallelepiped shape and the body 202a or 202b could be provided with a motor for applying a torque on the body 206.
[0041] In this case the robot R4 would have 3 degrees of freedom with force feedback in the plane, two in translation and one in rotation. The examples of robots presented above have 6 degrees of freedom including 3 to 6 with force feedback (Figure 2), 6 degrees of freedom (Figure 19), 3 degrees of freedom to act punctually in space ( figure 20) and 3 degrees of freedom including two or three return force to interact in the plane (Figures 21 and 22). But the robot could be redundant, with more than 6 motorized axes and a series structure or not. It could also have a parallel architecture, for example of the Gough-Stewart platform type. It could also have a hybrid architecture, for example with two branches in parallel and a serial axis as presented in the article F. Gosselin, Ferlay F., S. Bouchigny, C. Megard, F. Taha, Specification and design of a new haptic interface for maxillary facial surgery, Proc. IEEE Int. Conf. on Robotics and Automation, 913 May 2011, Shanghai, China, pp. 737-744, or with a Delta type carrier and a serial wrist as in article Y. Tsumaki, H. Naruse, D.N. Nenchev, M. Uchiyama, Design of a compact 6-DOF haptic interface, Proc. IEEE Int. Conf. on Robotics and Automation, Leuven, Belgium, May 1998. One could still use a 3D or 6D stretched cable architecture as presented in the articles M. Ishii, M. Sato, A 3D Spatial Interface Device Using Tensed Strings, Presence: Teleoperators and Virtual Environments, Vol. 3 (1), pp. 81-86, 1994, S. Kim, Y. Koike, Sato M., Tension based 7 DOFs force feedback device: SPIDAR-G, Trans. on Control, Automation and Systems Engineering, Vol.4, No.1, March 2002, and M. Ortega, S. Coquillart, Prop-based haptic interaction with co-location and immersion: an automotive application, Proc. IEEE Int. Workshop on Haptic Audio Visual Environments and their Applications, Ottawa, Canada, 1-2 Oct 2005. An anthropomorphic architecture could also be used, such as on upper limb orthoses. These examples are given for information only and are not limiting. We will now describe a third embodiment of the invention, in which the contact zone is deformable.
[0042] FIG. 23 shows an example of a control device according to the third embodiment in which the contact zone is made deformable, at least on the side of the handle and / or the body 206. The structure and the operation of this device will be better understood with reference to Figure 24 which shows a partial sectional view of the device of Figure 23. The end of the robot has the shape of a C and has two bodies 206a, 206b. The first body 206a is integral with the pulley P62 and driven by the motor M6 and the second body 206b is movable in translation relative to the body 206a.
[0043] The body 206b is driven by a motor 405, so as to allow the bodies 206a and 206b to be moved away from or towards each other. It is understood that the bodies 206a and 206b could also both be mobile relative to the pulley P62 without departing from the scope of the invention. In this case they would each be powered by a motor or both synchronously by the same motor. The structure of the two bodies 206a, 206b is such that they define between them a zone of contact with the contact end of the handle. The contact end has a shape such that it cooperates with the two bodies 206a, 206b.
[0044] The first body 206a defines a first zone of the total contact zone, designated 402a, and the second body defines a second zone of the contact zone, designated 402b. The contact end has a first end 401a that can cooperate with the first zone 402a and a second end 401b can cooperate with the second zone 402b. The contact end is disposed relative to the bodies 206a, 206b so that the first end 401a is opposite the first zone 402a and the second end 401b is opposite the zone 402b. Thus, in free space, the motor 405 is controlled so that the bodies 206a and 206b are relatively distant from each other. Thus the first and second contact ends 401a and 401b can not easily contact the first 402a and second 402b contact areas. When the robot comes into contact, the motor 405 is controlled so that the bodies 206a and 206b come closer together, so that the first contact end 401a and the first contact area 402a come closer and the second contact end 401b and the second contact zone 402b, are also approaching, until they come into contact. Thus in contact, the handle is secured to the robot while in free space these two elements are separated. In the example shown, the motor 405 is a linear motor but it could also be a rotary motor. This motor can advantageously be provided with a position sensor (not shown). In a more general manner, the motor 405 and the bodies 206a and 206b form a clamp which can be closed around the zone or zones of contact of the handle. Any other solution for making this clamp could be used without departing from the scope of the invention. These clamps could also be used for all types of contact areas. In particular, first and second contact ends 401a, 401b and first and second conical contact areas 402a, 402b could be used. The contact ends 401a, 401b and the contact areas 402a, 402b could still be flat and maintained by simple pinching contact. The contact zone could still have more than one first and second contact area as will be described later. This embodiment makes it possible to best manage the transitions between free space and contacting, since it makes it possible to have a small distance between the surfaces 401 and 402 near the contact, a zero distance to the contact and a significant distance between these surfaces in free space. When the contact zone is modifiable, the distance information of the device controlled to its environment and the distance information of the handle relative to the robot are used to control the configuration of the contact zone. Thus, on the device of FIGS. 23 and 24, it is possible, for example, to drive the motor 405 so that the distance between the contact zones 402a, 402b and the contact ends 401a, 401b, is equal to the distance between the robot and its environment as soon as the piloted device approaches the contact. It is thus ensured that the distance between the handle and the robot will be zero as soon as the driven device comes into contact with its environment. This control step is shown in dotted lines on the flowchart of FIG. 29.
[0045] It will be understood that it would also be possible for the relative configuration of the contact ends to be modifiable and not that of the contact zones. It would still be possible for both the relative configuration of the contact ends and that of the contact areas to be modifiable. Furthermore any other method or control law, linear or not, based on any useful information, to vary the distance between the contact ends and the contact areas could be used without departing from the scope of the invention. It will also be understood that a similar approach can be used for all variants where the contact end and / or the contact area is controllable. FIG. 25 shows another embodiment of the third embodiment in which the contact zone is formed of a first 402a, a second 402b, a third 402c and a fourth 402d zone. of contact. These four contact zones are, in the example shown, each formed by a plane which is mobile in translation relative to the body 206 and actuated by motors 405a, 405b, 405c and 405d so as to modify their distance to the contact end 401 of the handle 1 which is parallelepipedic here but could take any other form, provided that the zones 402a to 402d are adapted. The operation of this device is similar to that of the device of FIGS. 23 and 24. In free space, the motors 405a to 405d are controlled so that the surfaces 402a to 402d are remote from the faces of the contact end 401. At the contact, they are controlled so that these contact areas are in contact with the faces of the contact end. In general, these surfaces forming the deformable contact zone produce a diaphragm which is closed on the end of the handle. Any other solution to make such a diaphragm could be used without departing from the scope of the invention, in particular those having the principle of synchronizing the movements of the various moving parts. Any other form would also be possible for the contact area. For example, a contact zone in the form of a pyramid or a deformable sphere is not outside the scope of the present invention. In FIG. 26, another variant of the third embodiment of the contact zone seen in partial section can be seen. The end body 206 has on its inner face a flexible surface serving as a contact zone 402. The volume between the inner face of the body 206 and this surface 402 is advantageously filled with a fine powder such as, for example, and without limitation the fine sand, iron filings, apricot kernel powder or coffee grounds. A pump 405 and a tank (not shown) fixed on the body 206 or offset for example on the base of the robot ensure, on command, the filling and emptying of this volume. Thus in free space is sucked powder so as to release space around the contact zone 401 of the handle. In contact, on the contrary, the powder is injected so as to press the surface 402 on the surface 401. Alternatively, a quantity of substantially identical powder is kept but air is injected or, on the contrary, a vacuum is made to render the deformable powder or solidify it. It will be understood that it could also be the contact surface 401 of the handle which could be deformable, for example inflated on contact to come into contact with the surface 402. The deformable surface could still be outside the surfaces 401 and 402. It could for example be linked to the body 206 and surround a portion of the zone 101 or be connected to the zone 101 and surround a portion of the body 206. The devices of Figures 23 to 26 are given by way of example. Other devices capable of modifying the distance between the contact ends of the handle and the contact zones of the terminal body of the robot so that they are distant in free space and contiguous to the contact could be used without departing from the scope of the invention. 'invention. As explained above, since the avatar, the slave robot or the cobot effector is blocked in contact with its environment, the movement of the handle to come into contact with the robot can be seen as a penetration in the environment or an overtaking of the handle compared to the avatar, the robot or the cobot. This exceeding is the lower the distance between the contact end 401 and the contact area 402 is low. Thanks to the implementation of contact zones and / or modifiable contact ends, it is possible to have no overflow at all by reducing this distance to zero in contact. The distance between the ends and the contact areas being modifiable, one can also have a large distance in free space so that the robot can follow the movements of the user even if he has a limited dynamic. In Figures 27 and 28, there can be seen an exemplary control device comprising a plurality of distinct contact areas. The robot of FIG. 27 is a parallel robot 2 with two branches 2a and 2b, each branch 2a, 2b carrying a contact zone 402a, 402b respectively. The handle 1 has two contact ends 401a, 401b. The contact areas 402a, 402b are arranged in the example shown so as to face each other, the handle 1 being intended to be disposed between these two contact zones 402a, 402b, each contact end 401a, 401b of the handle look at a contact area. In this example, the contact ends 401a, 401b are of pyramidal shape and the contact areas have a corresponding shape. Any other form for applying multi-directional force feedback may be suitable. In FIG. 27, the two branches of the robot have 6 degrees of freedom, all of which are advantageously actuated, which enables each branch to follow the movements of the handle in free space and to apply forces to it on contact. One could not operate some or all of the wrist axes of branches 2a and 2b.
[0046] In this case the end bodies of the two branches would follow the rotating handle either by bringing them into contact with the handle when it is inclined, or by advantageously integrating on these axes self-aligning devices with the handle such as those shown in Figure 10. This arrangement has the advantage of allowing to easily adjust the distance between the ends of the branches 2a and 2b and the handle 1 by driving the two robots.
[0047] This robot configuration is given as an example and we could use different robots or use more than 2 contact areas. One could for example develop a robot with 3 branches in parallel connected to the handle by 3 contact areas without departing from the scope of the invention.
[0048] It will be understood that the different modes and variants of the robot, the handle, the tracking system and the contact area / contact end can be combined without departing from the scope of the invention. The present invention makes it possible to create haptic interfaces that are perfectly transparent in free space. In addition, it makes it possible to produce haptic interfaces operating in a conventional manner in contact with, in particular, bilateral forces in the 6 directions of space. In addition, it is simple to implement and can be adapted to existing interfaces. The device according to the invention is suitable for the realization of any device having to perform complex movements while having a high transparency, such as, for example and without limitation, haptic interfaces, cobots, exoskeletons or robots interacting with them. the man via a tool or a handle. These systems are for example particularly suitable for simulators and training systems in surgery and in the medical world. These applications actually involve operations performed using tools (scalpels, milling cutter, ...), which is a feature of our invention. Thanks to the invention, it is possible to achieve a haptic interface with an apparent mass and minimal apparent friction in free space while providing significant efforts to contact, which is a wish of surgeons.
[0049] In addition one can provide to equip several grippers. It is then very easy to change since the gripper may not be linked to the tool. It is thus easy to simulate interventions requiring the successive use of several tools.

权利要求:
Claims (9)
[0001]
REVENDICATIONS1. A force feedback control device comprising: - a handle (1) intended to be manipulated by the user, said handle (1) comprising at least one gripping zone (101) by the user and at least one end of contact (401) integral with the gripping area for at least part of the operation of the control device; - a robot (2) provided with at least one terminal body (206) having at least one contact zone (402), said contact zone (402) being able to come into contact with the contact end (401) of the handle (1), - measuring means (3) of the relative configuration of the handle (1) with respect to the terminal body (206), - a controller (5) adapted to manage the displacement of the contact zone (402) with respect to the contact end (401) in a non-contact operating state, in an operating state of operation. contact of the contact zone (402) and the contact end (401) and in a state of operation t in which a force return can be applied to the handle (1) via the contact end (401), - the contact end (401) being movable relative to the contact zone (401). contact (402) during at least a portion of the operation of the control device, wherein the contact end (401) and the contact area (402) are shaped such that the contact area (402) is adapted to applying forces on the contact end (401) in at least two distinct directions so that the robot applies to the handle (1) a force feedback in said at least two distinct directions.
[0002]
A force feedback control device according to claim 1, wherein the contact end (401) or the contact area (402) forms a cavity and the contact area (402) or the contact end (401) a shape such that it houses at least partially in said cavity.
[0003]
A force feedback control device according to claim 2, wherein a clearance exists between the inner surfaces of said contact end (401) or contact area (402) cavity and the outer surfaces of the the contact area (402) or the contact end (401), so that the relative displacement of the contact end and the contact area is limited in all directions.
[0004]
The force feedback control device according to claim 3, wherein the contact end (401) has a spherical shape and the contact area (402) has a corresponding spherical shape or the contact end (401). ) has a parallelepipedal shape and the contact zone (402) has a corresponding parallelepiped shape.
[0005]
5. Control device according to one of claims 1 and 2, wherein the contact zone (402) or the contact end (401) forms a cavity of which the contact end (401) or the zone of contact contact (402) is free to exit.
[0006]
A force feedback control device according to claim 5, wherein the contact end (401) has a cylindrical side wall and a hemispherical end wall and the contact area (402) has a corresponding shape or the contact end (401) has a conical or frustoconical side wall and the contact area (402) has a corresponding shape.
[0007]
7 force return control device according to one of claims 1 to 6, wherein the contact zone (402) and / or the contact end (401) have a fixed shape.
[0008]
8 force feedback control device according to one of claims 1 to 6, wherein the handle (1) and / or the terminal body (206) comprises a deformable element for coming into contact with the terminal body and / or the handle respectively when deformed.
[0009]
9. force feedback control device according to one of claims 1 to 6, wherein the contact zone and / or the contact end are deformed b les. A force feedback control device according to claim 9, wherein the contact area and / or the contact end are delimited by a plurality of surfaces (402a, 402b, 402c, 402d) of which at least one is movable relative to to other surfaces. 11. A force feedback control device according to claim 9 or 10, wherein the contact zone and / or the contact end are formed at least in part by a flexible wall, the contacting between the zone of contact and the contact end being provided at least in part by the deformation of the flexible wall. 12. A force feedback control device according to claim 11, wherein the flexible wall defines a closed chamber, said device comprising a reservoir of material in the form of a fine powder and means for supplying the closed chamber, on command of the controller. . 13. A force feedback control device according to one of claims 1 to 12, wherein the measuring means (3) comprise a camera or camera flight time arranged so as to film the handle (1) and the terminal body (206), image processing means provided by the camera and preferably a lighting device. A force feedback control device according to claim 13, wherein the handle (1) and / or the end body (206) have at least one registration target (301, 302). The force feedback control device according to claim 14, wherein one or more targets (301, 302) emit a signal to distinguish them from other targets. 16. A force return control device according to one of claims 1 to 12 wherein the measuring means (3) are arranged on the handle and the terminal body, said measuring means comprising locating elements (33). on the handle (1) or the terminal body (206) and sensors (34) of said registration elements. The force feedback control device according to claim 16, wherein the registration elements (33) are light emitting diodes and the sensors (34) are phototransistors. 18. A force feedback control device according to one of claims 1 to 17, comprising means for temporary attachment (431, 432) of the handle and the terminal body. 19. A force feedback control device according to claim 18, wherein the temporary fastening means are such that the fastening is removed when sufficient force is applied to the contact end. 20. A force feedback control device according to claim 19, wherein the temporary fastening means are magnetic or mechanical means. A force feedback control device according to claim 18, wherein the temporary fastening means are controllable so as to allow cancellation of the connection to order. 22. A force feedback control device according to claim 21, wherein the controllable fastening means are of the electromagnetic type. The force return control device according to one of claims 1 to 22, comprising at least one alignment system (SG) automatically modifying the relative configuration of the handle (1) and the terminal body (206) of the robot in orientation, for example magnetic type. 24. A force return control device according to one of claims 1 to 23, comprising means for detecting the contact between the contact end (401) and the contact zone (402). The force return control device according to one of claims 1 to 24, comprising at least two contact zones (402a, 402b) and at least two contact ends (401a, 401b), the two contact zones. (402a, 402b) being movable relative to each other and / or both contact ends (401a, 401b) being movable relative to each other. 26. force feedback control device according to one of claims 1 to 25, wherein the robot is a series robot (R1) with six degrees of freedom, a hybrid robot (R2) with 6 degrees of freedom, a parallel robot with three degrees of freedom (R3) or a parallel robot with two or three degrees of freedom (R4). 27. A haptic interface comprising a force feedback control device according to one of claims 1 to 26 and a simulation software.28. Master robot system and slave robot comprising a force feedback control device according to one of claims 1 to 26 and a slave robot, the master robot being formed by the robot of the control device. 29. Collaborative robot comprising a force feedback control device according to one of claims 1 to 26 and an effector acting on the environment, mounted on the terminal body or on a separate body.

类似技术:

---

公开号 | 公开日 | 专利标题

---

EP3077161B1|2018-04-18|Control device with multidirectional force feedback

---

US10792809B2|2020-10-06|Robot grip detection using non-contact sensors

---

FR3040803A1|2017-03-10|GLOVE FOR VIRTUAL OR REMOTE HANDLING AND ASSOCIATED VIRTUAL OR REMOTE HANDLING SYSTEM

---

US20200262089A1|2020-08-20|Sensorized Robotic Gripping Device

---

Kemp et al.2008|A point-and-click interface for the real world: laser designation of objects for mobile manipulation

---

US20220058419A1|2022-02-24|Generating a model for an object encountered by a robot

---

US10967507B2|2021-04-06|Positioning a robot sensor for object classification

---

US10248201B2|2019-04-02|Wolverine: a wearable haptic interface for grasping in virtual reality

---

US10471591B1|2019-11-12|Object hand-over between robot and actor

---

US10748393B1|2020-08-18|Skin stretch instrument

---

TWI311943B|2009-07-11|Eye module

---

Falck et al.2019|DE VITO: A dual-arm, high degree-of-freedom, lightweight, inexpensive, passive upper-limb exoskeleton for robot teleoperation

---

FR2900086A1|2007-10-26|CONTROL DEVICE WITH TENSILE CABLES

---

FR2971864A1|2012-08-24|Virtual reality equipment i.e. immersive virtual reality environment equipment, for virtual reality interaction with human-machine interface car, has contact device with touch pad positioned at point where interface is intended to appear

---

FR3023626A3|2016-01-15|NAVIGATION DEVICE IN VIRTUAL REALITY COMPRISING A HAPTIC INTERFACE

---

EP3671548A1|2020-06-24|System for viewing a control space by adding graphic frontiers to an image taken by a camera

---

Thompson2001|Integration of visual and haptic feedback for teleoperation

---

US20210031373A1|2021-02-04|Robotic manipulators

---

AU2020325084A1|2022-02-24|Robotic manipulators

---

Yang et al.2016|Visual Servoing Control of Robot Manipulator

---

WO2019092386A1|2019-05-16|Gesture-based control system for actuators

---

WO2017055375A1|2017-04-06|High-fidelity haptic device

---

FR3003363A1|2014-09-19|REMOTE PILOT PILOT PIONEER IN DISPLACEMENT LOCATED ON DIGITAL TABLET CAPACITIVE SCREEN

---

FR3011950A1|2015-04-17|IMPROVING THE ERGONOMICS OF A DESIGNER

---

Kim et al.2011|Human-demonstration based approach for grasping unknown objects

同族专利:

---

公开号 | 公开日

---

EP3077161A1|2016-10-12|

---

FR3014348B1|2016-01-22|

---

JP6648021B2|2020-02-14|

---

US9895812B2|2018-02-20|

---

JP2016539017A|2016-12-15|

---

US20160332305A1|2016-11-17|

---

WO2015082636A1|2015-06-11|

---

EP3077161B1|2018-04-18|

引用文献:

---

公开号 | 申请日 | 公开日 | 申请人 | 专利标题

---

FR2809048A1|2000-05-18|2001-11-23|Commissariat Energie Atomique|Master arm for robot arm training or virtual reality simulation, uses fixed wrist attachment to arm and has three-degrees of freedom in wrist unit, with rotation axes meeting at common point|

---

DE102007053008A1|2007-11-05|2009-05-14|Repetzki, Sebastian, Dr.-Ing.|Target body and method for determining its spatial position|

---

US20120221145A1|2011-02-24|2012-08-30|Olympus Corporation|Master input device and master-slave manipulator|

---

US6704694B1|1998-10-16|2004-03-09|Massachusetts Institute Of Technology|Ray based interaction system|

---

JP2000246674A|1999-02-26|2000-09-12|Sony Corp|Inner force sense presenting device|

---

US6801187B2|2001-06-22|2004-10-05|Ford Global Technologies, Llc|System and method of interactive evaluation and manipulation of a geometric model|

---

US7190496B2|2003-07-24|2007-03-13|Zebra Imaging, Inc.|Enhanced environment visualization using holographic stereograms|

---

US8138895B2|2007-10-19|2012-03-20|Sony Corporation|Force/tactile feedback device|

---

JP4645678B2|2008-05-08|2011-03-09|ソニー株式会社|Information input / output device, information input / output method, and computer program|

---

US8497767B2|2009-03-02|2013-07-30|Butterfly Haptics, LLC|Magnetic levitation haptic interface system|

---

US9314306B2|2010-09-17|2016-04-19|Hansen Medical, Inc.|Systems and methods for manipulating an elongate member|

---

DE102012112247A1|2012-12-13|2014-06-18|How To Organize Gmbh|Handle element and gripper input module for a haptic input system|

---

US9501946B1|2013-12-17|2016-11-22|University Of South Florida|Systems and methods for stable haptic feedback over packet-switched networks|

---

US9946350B2|2014-12-01|2018-04-17|Qatar University|Cutaneous haptic feedback system and methods of use|US9616580B2|2012-05-14|2017-04-11|Sarcos Lc|End effector for a robotic arm|

---

EP3139843A4|2014-05-05|2018-05-30|Vicarious Surgical Inc.|Virtual reality surgical device|

---

US10406676B2|2014-05-06|2019-09-10|Sarcos Lc|Energy recovering legged robotic device|

---

US10766133B2|2014-05-06|2020-09-08|Sarcos Lc|Legged robotic device utilizing modifiable linkage mechanism|

---

US10533542B2|2014-05-06|2020-01-14|Sarcos Lc|Rapidly modulated hydraulic supply for a robotic device|

---

US10512583B2|2014-05-06|2019-12-24|Sarcos Lc|Forward or rearward oriented exoskeleton|

---

DE102016109800B3|2016-05-27|2017-06-01|Luer Luetkens|Capacitive approach to collaborative robots|

---

CA3034869A1|2016-09-02|2018-03-08|Exonetik Inc.|Telepresence controller and system using magnetorheological fluid clutch apparatuses|

---

US10765537B2|2016-11-11|2020-09-08|Sarcos Corp.|Tunable actuator joint modules having energy recovering quasi-passive elastic actuators for use within a robotic system|

---

US10919161B2|2016-11-11|2021-02-16|Sarcos Corp.|Clutched joint modules for a robotic system|

---

US10821614B2|2016-11-11|2020-11-03|Sarcos Corp.|Clutched joint modules having a quasi-passive elastic actuator for a robotic assembly|

---

US10828767B2|2016-11-11|2020-11-10|Sarcos Corp.|Tunable actuator joint modules having energy recovering quasi-passive elastic actuators with internal valve arrangements|

---

KR101764120B1|2016-11-21|2017-08-14|한국과학기술정보연구원|Method and apparatus for calculating inserting and removing force based on 3D modeling|

---

EP3579736A4|2017-02-09|2020-12-23|Vicarious Surgical Inc.|Virtual reality surgical tools system|

---

JP6959762B2|2017-05-19|2021-11-05|川崎重工業株式会社|Remote control robot system|

---

US10843330B2|2017-12-07|2020-11-24|Sarcos Corp.|Resistance-based joint constraint for a master robotic system|

---

US10906191B2|2018-12-31|2021-02-02|Sarcos Corp.|Hybrid robotic end effector|

---

US11241801B2|2018-12-31|2022-02-08|Sarcos Corp.|Robotic end effector with dorsally supported actuation mechanism|

---

CN109955284B|2019-03-11|2020-11-27|燕山大学|Force feedback device with two rotations and one movement and three degrees of freedom|

法律状态:
2015-12-31| PLFP| Fee payment|Year of fee payment: 3 |

---

2016-12-29| PLFP| Fee payment|Year of fee payment: 4 |

---

2018-01-02| PLFP| Fee payment|Year of fee payment: 5 |

---

2018-12-31| PLFP| Fee payment|Year of fee payment: 6 |

---

2020-10-16| ST| Notification of lapse|Effective date: 20200905 |

优先权:

---

申请号 | 申请日 | 专利标题

---

FR1362268A|FR3014348B1|2013-12-06|2013-12-06|MULTIDIRECTIONAL EFFORT RETENTION CONTROL DEVICE|FR1362268A| FR3014348B1|2013-12-06|2013-12-06|MULTIDIRECTIONAL EFFORT RETENTION CONTROL DEVICE|

---

JP2016536772A| JP6648021B2|2013-12-06|2014-12-04|Control device with multi-directional force feedback, haptic interface, master and slave robot systems, and cooperating robots|

---

PCT/EP2014/076621| WO2015082636A1|2013-12-06|2014-12-04|Control device with multidirectional force feedback|

---

US15/102,211| US9895812B2|2013-12-06|2014-12-04|Control device with multidirectional force feedback|

---

EP14809621.7A| EP3077161B1|2013-12-06|2014-12-04|Control device with multidirectional force feedback|