MOBILE ROBOT DEVICE AND CONTROL METHOD THEREFOR
Patent Information
- Application Number
- DE602021038550
- Authority / Receiving Office
- DE · DE
- Patent Type
- Patents
- Current Assignee / Owner
- Priority Date
- 2021-01-28
- Filing Date
- 2021-11-30
- Publication Date
- 2025-09-10
- Estimated Expiration
- 2041-11-30
AI Technical Summary
Conventional two-wheeled robots face challenges in obstacle detection and path generation due to changes in the camera or sensor's angle of view when moving, making stable self-balancing difficult.
A mobile robot apparatus that moves rectilinearly along an inclined reference axis, using a processor to control the main body's position relative to the wheels, offsetting inertial and gravitational torques to maintain stability and ensure a consistent camera view for precise obstacle detection and path generation.
Enables stable self-balancing and precise obstacle detection by maintaining a consistent camera angle, allowing for accurate path planning and navigation.
Description
Technical Field
[0001] The disclosure relates to a mobile robot apparatus and a control method therefor, and more particularly, to a mobile robot apparatus that can travel stably as self-balancing is implemented by a main body that rectilinearly moves relatively to wheels along an inclined reference axis, and a control method therefor.Description of the Related Art
[0002] As robot technologies have developed, supply of robots is becoming generalized not only in specialized academic fields or industrial fields requiring a grand scale labor force but also in general homes. Also, not only robots performing functions while their positions are fixed but also two-wheeled robots that can move their positions are being distributed.
[0003] A conventional two-wheeled robot generally performs self-balancing control by inclining the main body forward or backward. However, in case the robot utilizes image data detected by a camera or a sensor, an angle of view of the camera or the sensor arranged on the main body continually changes, and thus there is a problem that it is difficult to detect an obstacle or generate a dynamic path.
[0004] US2020124159A1 discloses a shifting assembly and mobile carrier comprising same.Detailed Description of the Invention Technical Task
[0005] The disclosure is for addressing the aforementioned need, and the purpose of the disclosure is in providing a mobile robot apparatus that can travel stably as self-balancing is implemented by a main body that rectilinearly moves relatively to wheels along an inclined reference axis, and a control method therefor.Technical Solution
[0006] According to the present invention there is provided an apparatus and method as set forth in the appended claims. Other features of the invention will be apparent from the dependent claims, and the description which follows.Brief description of the drawings
[0007] FIG. 1 is a perspective view of a mobile robot apparatus according to one or more embodiments of the disclosure; FIG. 2 is a perspective view indicating a state wherein the main body in FIG. 1 ascended; FIG. 3 is a block diagram for illustrating an operation of a mobile robot apparatus according to one or more embodiments of the disclosure; FIG. 4 is a side surface view indicating a state wherein a mobile robot apparatus is accelerating; FIG. 5 is a side surface view indicating a state wherein a mobile robot apparatus is decelerating; FIG. 6 is a side surface view indicating a state wherein a mobile robot apparatus moves at a constant velocity; FIG. 7 is an exploded perspective view of a mobile robot apparatus according to one or more embodiments of the disclosure; FIG. 8 is a cross-sectional view wherein the mobile robot apparatus illustrated in FIG. 1 was cut according to the I - I line; FIG. 9 is a cross-sectional view wherein the mobile robot apparatus illustrated in FIG. 1 was cut according to the II - II line; FIG. 10 is a side surface view of a first wheel according to one or more embodiments of the disclosure; and FIG. 11 is a flow chart for illustrating a control method for a mobile robot apparatus according to one or more embodiments of the disclosure. Best Mode for Implementing the Invention
[0008] Hereinafter, the disclosure will be described in more detail with reference to the accompanying drawings.
[0009] FIG. 1 is a perspective view of a mobile robot apparatus according to one or more embodiments of the disclosure. FIG. 2 is a perspective view indicating a state wherein the main body in FIG. 1 ascended. FIG. 3 is a block diagram for illustrating an operation of a mobile robot apparatus according to one or more embodiments of the disclosure.
[0010] The mobile robot apparatus 1 is an apparatus having various functions such as recognizing the surrounding environment and being able to travel autonomously and collecting information, and transmitting information to a user, etc. The mobile robot apparatus 1 may recognize the surrounding environment based on recognition of voices, sounds, and images. Also, the mobile robot apparatus 1 may transmit information to a user by controlling another electronic product or outputting a voice through wireless communication.
[0011] The mobile robot apparatus 1 may enable stable autonomous traveling by collecting and analyzing various kinds of information such as sounds, voices, images, etc. in the surrounding environment. For example, the mobile robot apparatus 1 may include a microphone, a camera, a sensor, etc. for collecting information on the surrounding environment.
[0012] The mobile robot apparatus 1 may physically move by including a driving member, and may execute various functions of the mobile robot apparatus 1 across the overall environment of a user including the indoors and the outdoors through this.
[0013] In case the mobile robot apparatus 1 is used in a home, the mobile robot apparatus 1 may interact with electronic products such as a TV, a cleaner, a washing machine, etc. arranged in the home and execute functions and collect information, and transmit the collected information to the family members including a pet. Accordingly, all members in the home may be connected with the electronic products.
[0014] Even in case the user is not present, the mobile robot apparatus 1 may continuously check and inspect the environment inside the home, and may connect a family member needing help including the pet and the user. Also, the mobile robot apparatus 1 may check and manipulate other home appliances in the home through a physical movement. Through this, the mobile robot apparatus 1 can promote safety and reinforce security inside the home.
[0015] The mobile robot apparatus 1 according to one or more embodiments of the disclosure may be implemented in a form of performing tasks inside a home, but is not limited thereto, and it may be implemented as robot apparatuses according to various embodiments.
[0016] Referring to FIG. 1 to FIG. 3, the mobile robot apparatus 1 according to one or more embodiments of the disclosure may include a main body 100, a first wheel 200 and a second wheel 300, a first driving device 400, a second driving device 500, a processor 600, a tilt sensor 700, and an acceleration sensor 800.
[0017] The covers of the main body 100, the first wheel 200, and the second wheel 300 may have the same curvature, and accordingly, the exterior of the mobile robot apparatus 1 may be formed to constitute a sphere. Specifically, the side surfaces of the first and second wheels 200, 300 may have a convex shape.
[0018] Although not illustrated in FIG. 1 to FIG. 3, inside the main body 100 of the mobile robot apparatus 1, a motor, a battery, an actuator, a gear, a bearing, etc. for driving the mobile robot apparatus 1 may be included.
[0019] On the outer surface of the main body 100, a camera 101 photographing the surrounding environment of the mobile robot apparatus 1 may be arranged. Specifically, the camera 101 may be arranged on the front surface of the main body 100, and photograph the front side of the mobile robot apparatus 1. The processor 600 may generate moving paths of an obstacle around the mobile robot apparatus 1 and the mobile robot apparatus 1 based on photographing information received from the camera 101.
[0020] Also, the main body 100 may include a tilt sensor 700 and an acceleration sensor 800 in its inside. However, types of sensors are not limited thereto, and the mobile robot apparatus 1 may include at least one of an image sensor detecting obstacles, a sound sensor detecting voices, a temperature sensor that can detect temperatures, or a humidity sensor detecting humidity.
[0021] The tilt sensor 700 may detect in an angle of which degree the main body 100 is inclined in which direction by detecting the direction of the acceleration of gravity.
[0022] The acceleration sensor 800 may detect acceleration of the main body 100. Specifically, the acceleration sensor 800 may detect in which degree of acceleration the main body 100 as it accelerates forward, the degree of deceleration of the main body 100 as it decelerates backward, or whether the main body 100 moves at a constant velocity.
[0023] The mobile robot apparatus 1 can recognize the surrounding environment based on information collected from the camera 101 and the at least one sensor 700 arranged on the main body 100, and travel autonomously and collect information, and transmit the information to a user.
[0024] The first wheel 200 and the second wheel 300 are respectively arranged on either side of the main body 100.
[0025] Meanwhile, the first driving device 400 rotates the first and second wheels 200, 300 respectively based on a center axis X1.
[0026] As the first and second wheels 200, 300 rotate based on the center axis X1, the mobile robot apparatus 1 may move forward or backward, or pivot, and may thereby move freely to a desired location.
[0027] The first and second wheels 200, 300 may respectively move in a state of adjoining the sides of the main body 100 along both of the sides of the main body 100. The first and second wheels 200, 300 may move up and down to be relatively rectilinear to the main body 100.
[0028] The second driving device 500 may move the main body 100 to become far from or close to the center axis X1 of the first and second wheels 200, 300.
[0029] For example, the main body 100 in FIG. 1 may be arranged to be adjacent to the center axis X1 of the first and second wheels 200, 300. Here, the first and second wheels 200, 300 may cover the entire sides of the main body 100.
[0030] Also, the main body 100 in FIG. 2 may be arranged to be spaced apart from the center axis X1 of the first and second wheels 200, 300. Here, the first and second wheels 200, 300 may not cover the upper areas of the sides of the main body 100, and accordingly, the upper areas of the sides of the main body 100 may be exposed to the outside.
[0031] In case the mobile robot apparatus 1 needs to travel at a high speed, or needs to avoid an obstacle, the processor 600 may control the second driving device 500 so that the main body 100 moves to the upper side based on the center axis X1 of the first and second wheels 200, 300.
[0032] The main body 100 in FIG. 1 and FIG. 2 is illustrated to move up and down based on the vertical line, but the moving directions of the main body 100 are not limited thereto, and in a case where the main body 100 is inclined forward, the main body 100 may also move to the upper side on the front and the lower side on the rear.
[0033] The mobile robot apparatus 1 may include a processor 600 for controlling the operations of the mobile robot apparatus 1, and may include a sensor for recognizing the surrounding environment and a communication device for communicating with other electronic apparatuses.
[0034] The processor 600 may control the overall operations of the mobile robot apparatus 1. For this, the processor may include one or more of a central processing unit (CPU), an application processor (AP), or a communication processor (CP). Also, the processor may be a micro control unit (MCU).
[0035] The processor 600 may drive the operation system or an application program and control hardware or software components connected to the processor 600, and perform various kinds of data processing and operations. Also, the processor 600 may load an instruction or data received from at least one of other components on a volatile memory and process them, and store various data in a nonvolatile memory.
[0036] The processor 600 may control the first driving device 400 and the second driving device 500 based on information received from the camera 101, the tilt sensor 700, and the acceleration sensor 800. The content regarding the feature that the processor 600 controls the first and second driving devices 400, 500 will be described in detail later.
[0037] FIG. 4 is a side surface view indicating a state wherein a mobile robot apparatus is accelerating. FIG. 5 is a side surface view indicating a state wherein a mobile robot apparatus is decelerating. FIG. 6 is a side surface view indicating a state wherein a mobile robot apparatus moves at a constant velocity.
[0038] Referring to FIG. 4 to FIG. 6, the second driving device 500 rectilinearly moves the main body 100 along a reference axis S inclined at a predetermined angle θ more forward than the vertical line Z2.
[0039] The predetermined angle is 5 degrees or larger and 60 degrees or smaller.
[0040] That is, the mobile robot apparatus 1 may move while the main body 100 is inclined to the front side Y1. For this, if the mobile robot apparatus 1 moves backward for a short time and then stops before departing to the front side Y1, the main body 100 may be arranged to be inclined to the front side Y1 by an inertia torque in the T1 direction.
[0041] Referring to FIG. 4 and FIG. 5, the processor 600 controls the second driving device 500 so that, if the mobile robot apparatus 1 accelerates, the main body 100 moves in the traveling direction of the mobile robot apparatus 1.
[0042] Also, the processor 600 controls the second driving device 500 so that, if the mobile robot apparatus 1 decelerates, the main body 100 moves in the opposite direction of the traveling direction of the mobile robot apparatus 1.
[0043] Specifically, referring to FIG. 4, the processor 600 may control the second driving device 500 so that, if the mobile robot apparatus 1 accelerates forward to the front side Y1, or decelerates backward to the rear side Y2, the main body 100 moves to the front side Y1.
[0044] That is, the center axis X2 of the main body 100 may rectilinearly move to be far from the center axis X1 of the first and second wheels 200, 300 along the reference axis S. Accordingly, the distance D between the center axis X1 of the first and second wheels 200, 300 and the center axis X2 of the main body 100 may become longer.
[0045] Accordingly, the main body 100 may move to a first position wherein the center of gravity M of the main body 100 is located more to the front side Y1 than the grounding point C of the first and second wheels 200, 300. That is, the vertical line Z1 going through the center of gravity M of the main body 100 may be located more to the front side Y1 than the vertical line Z2 going through the grounding point C.
[0046] To the mobile robot apparatus 1, by the gravity applied to the center of gravity M of the main body 100 that moved to the first position, a compensation torque in the T1 direction (the counterclockwise direction in FIG. 4) may be applied. Meanwhile, the mobile robot apparatus 1 accelerates toward the front side Y1, or decelerates toward the rear side Y2, and thus an inertia torque in the T2 direction (the clockwise direction in FIG. 4) may be applied.
[0047] That is, to the mobile robot apparatus 1, a compensation torque in the T1 direction by gravity and an inertia torque in the T2 direction by inertial force are applied simultaneously, and thus the torques may be offset with each other.
[0048] Accordingly, the mobile robot apparatus 1 may not be inverted to the front side Y1 or the rear side Y2, but may accelerate forward toward the front side Y1 or decelerate backward toward the rear side Y2 stably.
[0049] Also, referring to FIG. 5, the processor 600 may control the second driving device 500 so that, if the mobile robot apparatus 1 decelerates forward to the front side Y1 or accelerates backward to the rear side Y2, the main body 100 moves to the rear side Y2.
[0050] Specifically, the center axis X2 of the main body 100 may rectilinearly move to be close to the center axis X1 of the first and second wheels 200, 300 along the reference axis S. Accordingly, the distance D between the center axis X1 of the first and second wheels 200, 300 and the center axis X2 of the main body 100 may become shorter.
[0051] Accordingly, the main body 100 may move to a second position wherein the center of gravity M of the main body 100 is located more to the rear side Y2 than the grounding point C of the first and second wheels 200, 300. That is, the vertical line Z1 going through the center of gravity M of the main body 100 may be located more to the rear side Y2 than the vertical line Z2 going through the grounding point C.
[0052] To the mobile robot apparatus 1, a compensation torque in the T2 direction (the clockwise direction in FIG. 5) may be applied by the gravity applied to the center of gravity M of the main body 100 that moved to the second position. As the mobile robot apparatus 1 decelerates toward the front side Y1 or accelerates toward the rear side Y2, and thus an inertia torque in the T1 direction (the counterclockwise direction in FIG. 5) may be applied.
[0053] That is, to the mobile robot apparatus 1, a compensation torque in the T2 direction by gravity and an inertia torque in the T1 direction by inertial force are applied simultaneously, and thus the torques may be offset with each other.
[0054] Accordingly, the mobile robot apparatus 1 may not be inverted to the front side Y1 or the rear side Y2, but may decelerate forward toward the front side Y1 or accelerate backward toward the rear side Y2 stably.
[0055] Also, the processor 600 may control the first driving device 400 so that the tilt of the main body 100 is maintained while the mobile robot apparatus 1 is moving based on a signal received from the tilt sensor 700.
[0056] If the first driving device 400 decreases the rotation angular velocity of the first and second wheels 200, 300, the main body 100 may be further inclined to the front side Y1 by inertia. On the contrary, if the first driving device 400 increases the rotation angular velocity of the first and second wheels 200, 300, the main body 100 may be further inclined to the rear side Y2. That is, according to the first driving device 400 increasing or decreasing the rotation angular velocity of the first and second wheels 200, 300, the tilt of the main body 100 may be adjusted.
[0057] The processor 600 may perform a PID control based on a tilt value of the main body 100 received from the tilt sensor 700, and thus the mobile robot apparatus 1 may move in an inclined state while the main body 100 maintains a predetermined angle.
[0058] Accordingly, the reference axis S which is the moving path of the main body 100 may be maintained at a regular angle θ with the vertical line Z2.
[0059] Meanwhile, even if self-balancing of the mobile robot apparatus 1 is performed through the aforementioned process, as the main body 100 is inclined at a regular angle, the camera 101 arranged on the front surface of the main body 100 may also photograph the front side always at a specific angle of view.
[0060] That is, the camera 101 photographs the surrounding environment of the mobile robot apparatus 1 at a regular angle of view in all cases wherein the mobile robot apparatus 1 accelerates, decelerates, and moves at a constant velocity, and thus the camera 101 may photograph the surrounding environment precisely and stably. Accordingly, through the image data stably collected by the camera 101, the mobile robot apparatus 1 can easily detect an obstacle, and can generate a precise dynamic path.
[0061] Referring to FIG. 6, the processor 600 may control the second driving device 500 so that, if the mobile robot apparatus 1 moves at a constant velocity, the main body 100 moves to a third position arranged between the first and second positions.
[0062] Specifically, the main body 100 may be arranged to be adjacent to the grounding point C of the first and second wheels 200, 300 in the third position. That is, the vertical line Z1 going through the center of gravity M of the main body 100 may be located to be adjacent to the vertical line Z2 going through the grounding point C.
[0063] It was illustrated that the center of gravity M of the main body 100 is arranged on the same vertical line as the grounding point C in the third position. However, the location is not limited thereto, and the center of gravity M of the main body 100 may be arranged inside a support polygon of the mobile robot apparatus 1 in the third position, and a torque by the gravity of the main body 100 may not be applied to the mobile robot apparatus 1.
[0064] In case the mobile robot apparatus 1 moves at a constant velocity, the mobile robot apparatus 1 does not receive both of an inertia torque by acceleration or deceleration and a compensation torque by the center of gravity of the main body 100, and thus the mobile robot apparatus 1 may travel stably without being inverted to the front side or the rear side.
[0065] FIG. 7 is an exploded perspective view of a mobile robot apparatus according to one or more embodiments of the disclosure. FIG. 8 is a cross-sectional view wherein the mobile robot apparatus illustrated in FIG. 1 was cut according to the I - I line. FIG. 9 is a cross-sectional view wherein the mobile robot apparatus illustrated in FIG. 1 was cut according to the II - II line. FIG. 10 is a side surface view of a first wheel according to one or more embodiments of the disclosure.
[0066] Referring to FIG. 8 to FIG. 11, the first wheel 200 may include a first wheel cover 210 and a first middle member 220, and the second wheel 300 may include a second wheel cover 310 and a second middle member 320.
[0067] Also, the first driving device 400 may include a first motor 410 providing a driving force to the first wheel 200 and a second motor 420 providing a driving force to the second wheel 300.
[0068] Further, the second driving device 500 may include racks 530, 560 arranged on at least one of the first and second wheels 200, 300, and pinions 520, 550 arranged to be engaged with the racks 530, 560 inside the main body 100.
[0069] The first and second wheel covers 210, 310 may respectively be rotatably connected to the first and second middle members 220, 320 that do not rotate. Also, both sides of the main body 100 may respectively be connected to the first and second middle members 220, 320 to be rotatable up and down.
[0070] That is, the first and second wheel covers 210, 310 may rotate based on the first and second middle members 220, 320, and the main body 100 may move up and down based on the first and second middle members 220, 320.
[0071] The first and second middle members 220, 320 may be arranged between the wheel covers 210, 310 and the main body 100, and support the first driving device 400, the racks 530, 560, and the guide rails 221, 321.
[0072] The first motor 410 may be arranged on the first middle member 220 and rotate the first wheel cover 210, and the second motor 420 may be arranged on the second middle member 320 and rotate the second wheel cover 310.
[0073] Specifically, the second driving device 500 may include a third motor 510, a first pinion 520, a first rack 530, a fourth motor 540, a second pinion 550, and a second rack 560.
[0074] The first pinion 520 may be arranged to be engaged with the first rack 530 inside the main body 100, and the first rack 530 may be arranged inside the first wheel 200.
[0075] If the third motor 510 rotates the first pinion 520, the first pinion 520 may move along the first rack 530. Accordingly, the main body 100 and the first wheel 200 may relatively move up and down.
[0076] The second pinion 550 may be arranged to be engaged with the second rack 560 inside the main body 100, and the second rack 560 may be arranged inside the second wheel 300.
[0077] If the fourth motor 540 rotates the second pinion 550, the second pinion 550 may move along the second rack 560. Accordingly, the main body 100 and the second wheel 300 may relatively move up and down.
[0078] The first and second racks 530, 560 may be arranged perpendicularly. Accordingly, the main body 100 may move in a direction perpendicular to the ground surface relatively to the first and second wheels 200, 300.
[0079] Also, the first and second racks 530, 560 may respectively be arranged on the first and second middle members 220, 320. Accordingly, the first and second racks 530, 560 maintain specific shapes regardless of the rotations of the first and second wheel covers 210, 310, and thus the main body 100 may stably move up and down relatively to the first and second middle members 220, 320.
[0080] As described above, as the second driving device includes a pair of motors 510, 540, pinions 520, 550, and racks 530, 560, the main body 100 may stably move up and down.
[0081] Also, the mobile robot apparatus 1 may further include guide rails 221, 321 arranged on at least one of the first and second middle members 220, 320, and the main body 100 may include blocks 110, 120 that are movable along the guide rails 221, 321 on the sides.
[0082] Specifically, the first guide rail 221 may be arranged on the first middle member 220, and the second guide rail 321 may be arranged on the second middle member 320. The first and second guide rails 221, 321 may be arranged perpendicularly.
[0083] Also, the main body 100 may include a first block 110 that is movable along the first guide rail 221 on one side, and a second block 120 that is movable along the second guide rail 321 on the other side.
[0084] As the first and second blocks 110, 120 of the main body 100 move while being respectively coupled with the first and second guide rails 221, 321, the main body 100 may move up and down relatively to the first and second middle members 220, 320. Also, as the first and second guide rails 221, 321 guide the moving path of the main body 100, the main body 100 may move up and down more stably.
[0085] FIG. 11 is a flow chart for illustrating a control method for a mobile robot apparatus according to one or more embodiments of the disclosure.
[0086] Referring to FIG. 11, a control method for the mobile robot apparatus 1 wherein a first wheel 200 and a second wheel 300 are respectively arranged at both sides of the main body 100 according to one or more embodiments of the disclosure includes the operations of sensing the acceleration of the mobile robot apparatus 1 (S1110). In addition, one or more embodiments of the disclosure may include identifying whether the mobile robot apparatus 1 accelerates (S1120). In addition, one or more embodiments of the disclosure includes, based on the mobile robot apparatus 1 accelerating, the main body 100 moving in the traveling direction of the mobile robot apparatus 1 (S1130). In addition, one or more embodiments of the disclosure may include identifying whether the mobile robot apparatus 1 decelerates (S1140). In addition, one or more embodiments of the disclosure includes, based on the mobile robot apparatus 1 decelerating, the main body 100 moving in the opposite direction of the traveling direction of the mobile robot apparatus 1 (S1150).
[0087] Also, the main body 100 rectilinearly moves along a reference axis S inclined at a predetermined angle θ more forward than the vertical line Z2.
[0088] In addition, the operation of moving in the traveling direction (S1130) may include the operations of, based on the mobile robot apparatus 1 accelerating forward, the main body 100 moving to a first position wherein the center of gravity M of the main body 100 is located more forward than the grounding point C of the first and second wheels 200, 300, and based on the mobile robot apparatus 1 accelerating backward, the main body 100 moving to a second position wherein the center of gravity M of the main body 100 is located more backward than the grounding point C of the first and second wheels 200, 300.
[0089] Also, the operation of traveling in the opposite direction of the traveling direction (S1150) may include the operations of, based on the mobile robot apparatus 1 decelerating forward, the main body 100 moving to the second position, and based on the mobile robot apparatus 1 decelerating backward, the main body 100 moving to the first position.
[0090] Accordingly, in the mobile robot apparatus 1, an inertia torque by acceleration or deceleration and a compensation torque by the center of gravity of the main body 100 are offset with each other, and thus the mobile robot apparatus 1 may travel stably without being inverted to the front side or the rear side.
[0091] Also, the control method for the mobile robot apparatus 1 may further include the operation of, based on the mobile robot apparatus 1 not accelerating or decelerating, the center of gravity M of the main body 100 moving to a position corresponding to the grounding point C of the first and second wheels 200, 300 (S1160).
[0092] That is, in case the mobile robot apparatus 1 moves at a constant velocity, the center of gravity M of the main body 100 may move to a third position arranged between the first position and the second position. Accordingly, the mobile robot apparatus 1 does not receive both of an inertia torque by acceleration or deceleration and a compensation torque by the center of gravity of the main body 100, and thus the mobile robot apparatus 1 may travel stably without being inverted to the front side or the rear side.
[0093] While preferred embodiments of the disclosure have been shown and described, the disclosure is not limited to the aforementioned specific embodiments, and it is apparent that various modifications can be made by those having ordinary skill in the art to which the disclosure belongs, without departing from the gist of the disclosure as claimed by the appended claims, and such modifications are within the scope of the descriptions of the claims. member 220, and the second guide rail 321 may be arranged on the second middle member 320. The first and second guide rails 221, 321 may be arranged perpendicularly.
[0094] Also, the main body 100 may include a first block 110 that is movable along the first guide rail 221 on one side, and a second block 120 that is movable along the second guide rail 321 on the other side.
[0095] As the first and second blocks 110, 120 of the main body 100 move while being respectively coupled with the first and second guide rails 221, 321, the main body 100 may move up and down relatively to the first and second middle members 220, 320. Also, as the first and second guide rails 221, 321 guide the moving path of the main body 100, the main body 100 may move up and down more stably.
[0096] FIG. 11 is a flow chart for illustrating a control method for a mobile robot apparatus according to one or more embodiments of the disclosure.
[0097] Referring to FIG. 11, a control method for the mobile robot apparatus 1 wherein a first wheel 200 and a second wheel 300 are respectively arranged at both sides of the main body 100 according to one or more embodiments of the disclosure may include the operations of sensing the acceleration of the mobile robot apparatus 1 (S1110), identifying whether the mobile robot apparatus 1 accelerates (S1120), and based on the mobile robot apparatus 1 accelerating, the main body 100 moving in the traveling direction of the mobile robot apparatus 1 (S1130), identifying whether the mobile robot apparatus 1 decelerates (S1140), and based on the mobile robot apparatus 1 decelerating, the main body 100 moving in the opposite direction of the traveling direction of the mobile robot apparatus 1 (S1150).
[0098] Also, the main body 100 may rectilinearly move along a reference axis S inclined at a predetermined angle θ more forward than the vertical line Z2.
[0099] In addition, the operation of moving in the traveling direction (S1130) may include the operations of, based on the mobile robot apparatus 1 accelerating forward, the main body 100 moving to a first position wherein the center of gravity M of the main body 100 is located more forward than the grounding point C of the first and second wheels 200, 300, and based on the mobile robot apparatus 1 accelerating backward, the main body 100 moving to a second position wherein the center of gravity M of the main body 100 is located more backward than the grounding point C of the first and second wheels 200, 300.
[0100] Also, the operation of traveling in the opposite direction of the traveling direction (S1150) may include the operations of, based on the mobile robot apparatus 1 decelerating forward, the main body 100 moving to the second position, and based on the mobile robot apparatus 1 decelerating backward, the main body 100 moving to the first position.
[0101] Accordingly, in the mobile robot apparatus 1, an inertia torque by acceleration or deceleration and a compensation torque by the center of gravity of the main body 100 are offset with each other, and thus the mobile robot apparatus 1 may travel stably without being inverted to the front side or the rear side.
[0102] Also, the control method for the mobile robot apparatus 1 may further include the operation of, based on the mobile robot apparatus 1 not accelerating or decelerating, the center of gravity M of the main body 100 moving to a position corresponding to the grounding point C of the first and second wheels 200, 300 (S1160).
[0103] That is, in case the mobile robot apparatus 1 moves at a constant velocity, the center of gravity M of the main body 100 may move to a third position arranged between the first position and the second position. Accordingly, the mobile robot apparatus 1 does not receive both of an inertia torque by acceleration or deceleration and a compensation torque by the center of gravity of the main body 100, and thus the mobile robot apparatus 1 may travel stably without being inverted to the front side or the rear side.
Claims
1. A mobile robot apparatus (1) comprising: a main body (100); a first wheel (200) and a second wheel (300) respectively provided on opposite sides of the main body (100); a first driving device (400) configured to rotate the first wheel (200) and the second wheel (300); a second driving device (500) configured to rectilinearly move the main body (100) relatively to the wheels along a reference axis (S) inclined at a predetermined angle (θ) more forward than a vertical line (Z2) wherein the predetermined angle is larger than 5 degrees and less than 60 degrees; and a processor (600) configured to: control the second driving device (500) so that, based on the mobile robot apparatus (1) accelerating, the main body (100) moves in the traveling direction of the mobile robot apparatus (1), and based on the mobile robot apparatus (1) decelerating, the main body (100) moves in the opposite direction of the traveling direction.
2. The mobile robot apparatus (1) of claim 1, wherein the main body (100) moves to a first position wherein the center of gravity of the main body (100) is located more forward than the grounding point of the first (200) and second (300) wheels or a second position wherein the center of gravity of the main body (100) is located more backward than the grounding point of the first (200) and second (300) wheels.
3. The mobile robot apparatus (1) of claim 2, wherein the processor (600) is further configured to: control the second driving device (500) so that, based on the mobile robot apparatus (1) accelerating forward or decelerating backward, the main body (100) moves to the first position, and based on the mobile robot apparatus (1) decelerating forward or accelerating backward, the main body (100) moves to the second position.
4. The mobile robot apparatus (1) of claim 3, wherein the processor (600) is configured to: control the second driving device (500) so that, based on the mobile robot apparatus (1) moving at a constant velocity, the main body (100) moves to a third position arranged between the first and second positions.
5. The mobile robot apparatus (1) of claim 1, further comprising: a tilt sensor (700) configured to detect a tilt of the main body (100).
6. The mobile robot apparatus (1) of claim 5, wherein the processor (600) is further configured to: control the first driving device (400) to maintain the tilt of the main body (100) while the mobile robot apparatus (1) is moving based on a signal received from the tilt sensor (700).
7. The mobile robot apparatus (1) of claim 1, further comprising: a camera (101) configured to photograph a surrounding environment of the mobile robot apparatus (1).
8. The mobile robot apparatus (1) of claim 7, Wherein the camera (101) is provided on a front surface of the main body (100).
9. The mobile robot apparatus (1) of claim 1, further comprising: an acceleration sensor (800) configured to detect acceleration or deceleration of the mobile robot apparatus (1).
10. The mobile robot apparatus (1) of claim 1, wherein the first driving device (400) comprises: a first motor (410) configured to provide a driving force to the first wheel (200); and a second motor (420) configured to provide a driving force to the second wheel (300).
11. The mobile robot apparatus (1) of claim 1, wherein the second driving device (500) comprises: a first rack (530) provided inside the first wheel (200); a second rack (560) provided inside the second wheel (300); a first pinion (520) engaged to be engaged with the first rack (530); a second pinion (550) engaged to be engaged with the second rack (560); a third motor (510) configured to rotate the first pinion (520); and a fourth motor (540) configured to rotate the second pinion (550).
12. The mobile robot apparatus (1) of claim 11, wherein the first wheel (200) comprises: a first wheel cover (210) that is rotatable; and a first middle member (220) arranged between the first wheel cover (210) and the main body (100), and the second wheel (300) comprises: a second wheel cover (310) that is rotatable; and a second middle member (320) arranged between the second wheel cover (310) and the main body (100), and the first rack (530) is provided on the first middle member (220), and the second rack (560) is provided on the second middle member (320).
13. The mobile robot apparatus (1) of claim 12, further comprising: a guide rail (221, 321) arranged on at least one of the first middle member (220) and the second middle member (320), wherein the main body (100) comprises: a block (110, 120) that is movable along the guide rail (221, 321) on the side surface.
14. A method of controlling a mobile robot apparatus (1) wherein a first wheel (200) and a second wheel (300) are respectively provided at both sides of a main body (100), the method comprising: sensing the acceleration of the mobile robot apparatus (1); based on the mobile robot apparatus (1) accelerating, the main body (100) moving in the traveling direction of the mobile robot apparatus (1); and based on the mobile robot apparatus (1) decelerating, the main body (100) moving in the opposite direction of the traveling direction, wherein the main body (100) rectilinearly moves relatively to the wheels along a reference axis (S) inclined at a predetermined angle (θ) more forward than the vertical line (Z2) wherein the predetermined angle is larger than 5 degrees and less than 60 degrees.
15. The control method for a mobile robot apparatus (1) of claim 14, wherein the moving in the travelling direction comprises: based on the mobile robot apparatus (1) accelerating forward, the main body (100) moving to a first position wherein the center of gravity of the main body (100) is located more forward than the grounding point of the first (200) and second (300) wheels; and based on the mobile robot apparatus (1) accelerating backward, the main body (100) moving to a second position wherein the center of gravity of the main body (100) is located more backward than the grounding point of the first (200) and second (300) wheels, and the moving in the opposite direction of the traveling direction comprises: based on the mobile robot apparatus (1) decelerating forward, the main body (100) moving to the second position; and based on the mobile robot apparatus (1) decelerating backward, the main body (100) moving to the first position.