The present invention relates to an object position estimation apparatus for use in estimating positions of a plurality of objects existing in a space to be observed based on observed values relating to corresponding objects sent from an observation device such as a sensor, an object position estimation method, and an object position estimation program.
Systems for estimating a state (for example, a position) of an object based on observed values from a sensor are mainly classified into a sequential (on-line) estimation system and a batch (off-line) estimation system.
The sequential estimation system is a system that sequentially processes observed values that are time-sequentially obtained, and is characterized in that, each time an observed value is obtained, a state estimation value of an object can be obtained at once, and in that computing costs are also inexpensive. However, in contrast, since the estimation is carried out based on only the observed value obtained each time, the system tends to be influenced by an observation error of the sensor or an erroneous observation, and has a problem in that the precision of its estimated value is seriously lowered when a deviated value is obtained as an observed value.
On the other hand, the batch estimation system is a system in which accumulated sensor observed values are batch-processed, and since a series of a plurality of observed values obtained time-sequentially are batch-processed, the resulting characteristic is that, after observed values for a predetermined period of time have been obtained, an estimating process is first carried out. Moreover, although there is a problem in that computing costs are high, the system is also characterized by being hardly susceptible to lowering of estimation precision due to a deviated value that might be caused by an observation error, an erroneous observation, or the like.
As a conventional technique for estimating a state of an object based on observed values of a sensor, a system has been proposed (Patent Document 1) in which both of the characteristics of the sequential estimation system and the batch estimation system are combined with each other.
In Patent Document 1, there are disclosed device and method in which by using the sequential estimation system and batch estimation system combined with each other, an orbit of a satellite is specified based on observed data of positions of the satellite.
More specifically, a basic cycle including three processing steps of 1) estimating a parameter for an equation of motion for regulating an orbit of a satellite by using a batch estimating process, 2) using the parameter for an equation of motion thus estimated as an initial value for a sequential estimating process, and 3) sequentially estimating the position of the satellite by using the sequential estimating process. A prediction error relating to the estimated position of the satellite is directed by the parameter for the equation of motion estimated by the batch estimating process, and this prediction error increases in response to an elapsed period of time from the completion of the batch estimation. By repeating the basic cycle at a timing in which a predetermined threshold value has been exceeded, this system is combined with the characteristic of high-precision estimation of the batch estimation and the characteristic of promptness of the sequential estimation.
However, the system disclosed in Patent Document 1 is based on the assumption that the position estimation of an object whose position continuously changes in response to an elapsed period of time described by a certain equation of motion is carried out. For this reason, when this system is used for the position estimation of such a semi-stationary object as to repeat a stationary state and a moving state at random, the sequential estimating process is continuously carried out even in a state in which the stationary state is taken for granted. As such a position estimation for a semi-stationary object, for example, an application is considered in which the system is used in a state that is not described by an equation of motion, that is, in a position estimation for such an object as to be carried by a person. In this case, even when position information is obtained with high precision by a batch estimating process, there is a problem in that the precision of the result of the position estimation is lowered by its sequential estimation that is susceptible to an observation error of a sensor and an erroneous observation.
Moreover, the system disclosed by Patent Document 1 is used on the assumption that, with respect to either a single object serving as an observation subject or a plurality of objects serving as the observation subjects, a correspondence relationship between the observed object and the observed value is uniquely determined. The resulting problem is that the system is not applicable to a position estimation of a plurality of objects in which the correspondence relationship between the observed values and the observed objects is indefinite.
The present invention has been devised to resolve the above-mentioned issue, and its objective is to provide an object position estimation apparatus and an object position estimation method as well as an object position estimation program which, even upon position estimation of such a semi-stationary object as to repeat a stationary state and a moving state at random, can highly maintain the precision of an estimated position, and is applicable to a position estimation for a plurality of objects in which the correspondence relationship between the observed value and the object to be observed becomes indefinite.
In order to resolve the above-mentioned issues, the present invention has the following arrangements:
In accordance with a first aspect of the present invention, there is provided an object position estimation apparatus comprising:
an object-state change determination unit that, each time an observed value including identification information of an object existing in an observation space to be observed and position information of the object is sequentially obtained, determines presence or absence of a state change as to whether or not the object inside the observation space is at least in a stationary state, based on a correspondence relationship between the observed value including the identification information and the position information of the object and object-state information corresponding to a latest estimated value relating to an existing state in the observation space of the object to be observed and a position of the object; and
a batch estimation unit that, when the object-state change determination unit determines that there is a change in the existing state of the object, estimates the identification information and the position information of the object, based on an observed value obtained during a predetermined period of time from time at which the object-state change determination unit has determined that there is the change in the existing state of the object and the existing state of the object determined by the object-state change determination unit.
In accordance with a second aspect of the present invention, there is provided an object position estimation apparatus comprising:
an object-state change determination unit that, each time an observed value including identification information of each of a plurality of objects existing in an observation space to be observed and position information of the object is sequentially obtained, determines presence or absence of a state change as to whether or not each of the objects inside the observation space is at least in a stationary state, based on a correspondence relationship between the observed value including the identification information and the position information of each of the objects and object-state information corresponding to a latest estimated value relating to an existing state in the observation space of the object to be observed and a position of the object; and
a batch estimation unit that, when the object-state change determination unit determines that there is a change in the existing state of the object, estimates the identification information and the position information of the object, based on an observed value obtained during a predetermined period of time from time at which the object-state change determination unit has determined that there is the change in the existing state of the object and the existing state of the object determined by the object-state change determination unit.
In accordance with a fifth aspect of the present invention, there is provided an object position estimation method comprising:
each time an observed value including identification information of each of a plurality of objects existing in an observation space to be observed and position information of the object is sequentially obtained, determining presence or absence of a state change as to whether or not each of the objects inside the observation space is at least in a stationary state, based on a correspondence relationship between the observed value including the identification information and the position information of each of the objects and object-state information corresponding to a latest estimated value relating to an existing state in the observation space of the object to be observed and a position of the object, by using an object-state change determination unit; and
when the object-state change determination unit determines that there is a change in the existing state of the object, estimating the identification information and the position information of the object by using a batch estimation unit, based on an observed value obtained during a predetermined period of time from time at which the object-state change determination unit determines that there is the change in the existing state of the object and the existing state of the object determined by the object-state change determination unit.
In accordance with a sixth aspect of the present invention, there is provided an object position estimation program allowing a computer to execute an object-state change determining means by which, each time an observed value including identification information of each of a plurality of objects existing in an observation space to be observed and position information of the object is sequentially obtained, presence or absence of a state change as to whether or not each of the objects inside the observation space is at least in a stationary state is determined, based on a correspondence relationship between the observed value including the identification information and the position information of each of the objects and object-state information corresponding to a latest estimated value relating to an existing state in the observation space of the object to be observed and a position of the object; and
a batch estimation means by which, when the object-state change determination means determines that there is a change in the existing state of the object, the identification information and the position information of the object are estimated, based on an observed value obtained during a predetermined period of time from time at which the object-state change determination means has determined that there is the change in the existing state of the object and the existing state of the object determined by the object-state change determination means.
In accordance with the object position estimation apparatus, the object position estimation method, and the object position estimation program of the present invention, it is possible to provide a remarkable effect in that, upon observation of a plurality of semi-stationary articles (for example, such objects as to move and stop repeatedly), after a position of each object has been determined with high precision by using a batch estimating process based on an observed value acquired from a point of time at which the object-state change determination means has determined that there is a change in the object state from a moving state to a stationary state, and an existing state of the object determined by the object-state change determination means, and during a stationary state of the article, the position information with high precision obtained by the batch estimation can be outputted as estimated information. In other words, the present invention is free from the prior art problem in that a positional error occurs due to a position estimation that is carried out by a sequential estimating process even on an object whose stationary state is taken for granted.
Moreover, in accordance with the object position estimation apparatus, the object position estimation method, and the object position estimation program of the present invention, it is possible to also obtain another effect in which, by determining a state change from a stationary state to a moving state of an object to be observed, or from a moving state to a stationary state thereof, by using the object-state change determination means, a stationary state of the object or a moving state thereof at an arbitrary point of time during observation can be confirmed with respect to all the objects.
These and other aspects and features of the present invention will become clear from the following description taken in conjunction with the preferred embodiments thereof with reference to the accompanying drawings, in which:
Referring to drawings, the following description will refer to embodiments of the present invention in detail.
Prior to the detailed description of the embodiments of the present invention with reference to the drawings, the following will describe various aspects of the present invention.
In accordance with a first aspect of the present invention, there is provided an object position estimation apparatus comprising:
an object-state change determination unit that, each time an observed value including identification information of an object existing in an observation space to be observed and position information of the object is sequentially obtained, determines presence or absence of a state change as to whether or not the object inside the observation space is at least in a stationary state, based on a correspondence relationship between the observed value including the identification information and the position information of the object and object-state information corresponding to a latest estimated value relating to an existing state in the observation space of the object to be observed and a position of the object; and
a batch estimation unit that, when the object-state change determination unit determines that there is a change in the existing state of the object, estimates the identification information and the position information of the object, based on an observed value obtained during a predetermined period of time from time at which the object-state change determination unit has determined that there is the change in the existing state of the object and the existing state of the object determined by the object-state change determination unit.
In accordance with a second aspect of the present invention, there is provided an object position estimation apparatus comprising:
an object-state change determination unit that, each time an observed value including identification information of each of a plurality of objects existing in an observation space to be observed and position information of the object is sequentially obtained, determines presence or absence of a state change as to whether or not each of the objects inside the observation space is at least in a stationary state, based on a correspondence relationship between the observed value including the identification information and the position information of each of the objects and object-state information corresponding to a latest estimated value relating to an existing state in the observation space of the object to be observed and a position of the object; and
a batch estimation unit that, when the object-state change determination unit determines that there is a change in the existing state of the object, estimates the identification information and the position information of the object, based on an observed value obtained during a predetermined period of time from time at which the object-state change determination unit has determined that there is the change in the existing state of the object and the existing state of the object determined by the object-state change determination unit.
In accordance with a third aspect of the present invention, there is provided an object position estimation apparatus described in the first aspect or the second aspect, wherein, when the object-state change determination unit determines that there is a change in the object to be observed from the stationary state to a moving state, and then during a period until determination that the moving state has been changed to the stationary state is made, the batch estimation unit neither carries out any estimating process on the identification information and the position information of the object, nor outputs the estimated value.
In accordance with a fourth aspect of the present invention, there is provided an object position estimation apparatus described in the first aspect or the second aspect, wherein, when the object-state change determination unit determines that there is a change in the object to be observed from a moving state to the stationary state, and then during a period until determination that the stationary state has been changed to the moving state is made, the batch estimation unit carries out an estimating process only once on the identification information and the position information of the object when determined that there is a change in the object into the stationary state, and then outputs the estimated value obtained by the estimating process as object state information of the object.
In accordance with a fifth aspect of the present invention, there is provided an object position estimation method comprising:
each time an observed value including identification information of each of a plurality of objects existing in an observation space to be observed and position information of the object is sequentially obtained, determining presence or absence of a state change as to whether or not each of the objects inside the observation space is at least in a stationary state, based on a correspondence relationship between the observed value including the identification information and the position information of each of the objects and object-state information corresponding to a latest estimated value relating to an existing state in the observation space of the object to be observed and a position of the object, by using an object-state change determination unit; and
when the object-state change determination unit determines that there is a change in the existing state of the object, estimating the identification information and the position information of the object by using a batch estimation unit, based on an observed value obtained during a predetermined period of time from time at which the object-state change determination unit determines that there is the change in the existing state of the object and the existing state of the object determined by the object-state change determination unit.
In accordance with a sixth aspect of the present invention, there is provided an object position estimation program allowing a computer to execute an object-state change determining means by which, each time an observed value including identification information of each of a plurality of objects existing in an observation space to be observed and position information of the object is sequentially obtained, presence or absence of a state change as to whether or not each of the objects inside the observation space is at least in a stationary state is determined, based on a correspondence relationship between the observed value including the identification information and the position information of each of the objects and object-state information corresponding to a latest estimated value relating to an existing state in the observation space of the object to be observed and a position of the object; and
a batch estimation means by which, when the object-state change determination means determines that there is a change in the existing state of the object, the identification information and the position information of the object are estimated, based on an observed value obtained during a predetermined period of time from time at which the object-state change determination means has determined that there is the change in the existing state of the object and the existing state of the object determined by the object-state change determination means.
With this arrangement, the object-state change determination means 101 calculates a correspondence relationship between respective observed values obtained from a plurality of objects in an observation space serving as examples of observed values including identification information of each of objects existing in the observation space to be observed and position information of the object, and the object state of each of the objects to be estimated in the object position estimation apparatus, for example, the latest object state of each of the objects. In a case where, as a result of calculations, an observed value that determines that there is a change in the existing state of the corresponding object, for example, an observed value that determines that the corresponding object state is not present, is found, it is determined that an object has newly appeared (or has been brought into an observable state) in the observation space. In contrast, in a case where there is an object state that is determined as no corresponding observed value being present, it is determined that an object has disappeared (or has been brought into an unobservable state) in the observation space.
Thus, based on the observed value acquired when the object-state change determination means 101 determines that there is a change in the existing state of an object in the observation space (for example, a plurality of observed values obtained in a fixed period (a predetermined number of times) from a timing at which the object-state change determination means 101 has determined that there is a change in the existing state of an object inside the observation space) and the existing state of the object determined by the object-state change determination means, a batch estimating process is carried out by the batch estimation means 102 so that the position estimation relating to each of the objects can be carried out with high precision, with the correspondence relationship between the observed values and the objects being taken into consideration.
Moreover, while the object-state change determination means 101 determines that no change in the existing state of an object is found, the estimated position, estimated with high precision by this batch estimating process, can be held in the object state information storage means 103, and continuously maintained as the latest object position information so that it is possible to avoid an observation error in the observing device or a deterioration in estimating position precision due to an influence from an observation error, in a positional estimating process for a semi-stationary object, such as an object that repeatedly stops and moves at random, which poses a problem in the sequential estimation.
Referring to the drawings, the following will describe embodiments of the present invention.
An object position estimation apparatus 200 in accordance with the first embodiment of the present invention allows an article-image recognizing sensor 209 serving as one example of an observing device to pick up an image inside a room such as a life space, as one example of an observation space, from its ceiling, and carries out a position detecting process and an article identifying process of an article serving as one example of an object through an image recognizing process so that based on observed information including the position information and the identification information, a change in an existing state of the article is determined to estimate the position of the article. In the present embodiment, a camera is used as one example of the article-image recognizing sensor 209. As shown in
As shown in
In this case, the number of the cameras forming the camera unit 209a possessed by the article-image recognizing sensor 209 is set to one; however, a plurality of cameras may be prepared. For example, a plurality of cameras, each having a small viewing angle, may be used to pick up the image of the entire room 300. Moreover, image pick-up ranges of cameras may be overlapped with one another so that images of the same range can be picked up from a plurality of directions.
The image recognizing unit 209b extracts an article area image from the picked-up image data outputted by the camera unit 209a by using a background differential method, and first specifies the position of the article. For example, as shown in
An observed value outputted from the article-image recognizing sensor 209 corresponds to data formed by combining the observed position of the recognized article with an observation ID likelihood representing a certainty as to which article the observed article is defined as, with respect to article ID's preliminarily assigned to each of the kinds of articles.
One example of the above-mentioned article ID is shown below. For example, as shown in
Additionally, in the present first embodiment, an image sensor provided with an image recognizing function is used as the article-image recognizing sensor 209 for observing articles inside the room 300; however, a sensor other than the image sensor may be used as long as it can identify the positions and kinds of the articles to be observed. For example, as another example of the article-image recognizing sensor 209, an RFID, or a laser range sensor, or the like, or a combination of a plurality of kinds of sensors may be used.
The observed value acquiring unit 201 of
The observed values acquired by the observation value acquiring unit 201 at once are a plurality of observed values corresponding to a plurality of articles that were observed. In
Simultaneously as the observation value acquiring unit 201 records the observed values in the observed value accumulating table 202, the observation value acquiring unit 201 outputs the values to the article-state change determination unit 203.
The observed value accumulating table 202 accumulates the observed values acquired by the observation value acquiring unit 201 together with the observed time.
Moreover, in the article-image recognizing sensor 209, since an article is recognized through an image recognition, there is a possibility of an identifying error of the article. The possibility of this error is quantitatively represented by a numeric value, referred to as “observation ID likelihood”. The meaning of “the observation ID likelihood” corresponds to a distribution of certainty for each of article ID's relating to the identified results of articles by the article-image recognizing sensor 209. In other words, “the observation ID likelihood” means a probability distribution as to which article each observed value is derived from.
The four observed values in the region 502 of FIG. 5 are observed values resulting from the observations of article ID=0001, article ID=0002, article ID=0003, and article ID=0004 successively in this order from the above.
The first observed value in the region 502 from the above has an observation ID likelihood value of 0.4 relative to article ID 0001, which is the highest value, and the observation ID likelihood of the other articles is 0.2. The observed value has a probability of 0.4 of being an observed value from the observation of article ID=0001, and also has a probability of 0.2 of being an observed value from the observation of an article other than the article with article ID=0001.
The observed value on the third line from the above of the region 502 has an observation ID likelihood value of 0.7 relative to article ID=0003, which is the highest value, and the observation ID likelihood of the other articles is 0.1. The observed value has a probability of 0.7 of being an observed value from the observation of article ID=0003, and also has a probability of 0.1 of being an observed value from the observation of an article other than the article with article ID=0003.
In the region 502, the third observed value has a probability (0.7) of being derived from the observation of article ID=0003, which is higher than a probability of (0.4) of the first observed value of being derived from the observation of article ID=0003, and from the viewpoint of reliability of article identification, the third observed value has higher reliability than that of the first observed value.
The state of an erroneous recognition of an article changes depending on image characteristics of the respective articles to be identified, or a difference in image characteristics between the articles, or illuminating conditions of the space in which the articles are observed, or states of occlusion (a state in which an object on the rear side is hardly recognizable because of an object positioned on the front side), or the like. For this reason, ideally, each time an observation is carried out, an observation. ID likelihood in which a probability of an erroneous recognition has been reflected should be calculated by taking its observation conditions into consideration; however, for this purpose, all the observation conditions need to be preliminarily evaluated, and actually, such operations cannot be executed.
In practice, identifying experiments of an object are carried out under certain fixed (or a plurality of limited) observation conditions, and an observation ID likelihood is preliminarily obtained for each of the articles based on the correction rate of article identification, and upon actually carrying out a position estimation on an article, an approximation process is carried out by assigning the observation ID likelihood that has been thus obtained. In the present first embodiment also, the observation ID likelihood to be outputted from the article-image recognizing sensor 209 is supposed to be preliminarily obtained through experiments.
Moreover, when two observed values shown in a region 503 are taken into consideration, the distribution of the observation ID likelihood shows that the first observed value in the region 503 has the highest probability of being derived from the observation of article ID=0001, and that the second observed value in the region 503 has the highest probability of being derived from the observation of article ID=0002.
However, when the error range of the observed position relative to the true position of an article is taken into consideration, it is understood that the first observed value is actually derived from the observation of article ID=0002, and the second observed value is derived from the observation of article ID=0001.
In other words, the region 503 of
Each time an observed value including identification information of an object existing in a room (one example of an observation space) to be observed and position information of the object is sequentially obtained, the article-state change determination unit 203 determines presence or absence of a state change as to whether or not the object inside the observation space is at least in a stationary state, based on the correspondence relationship between the observed value including the identification information and position information of the object and object-state information corresponding to the latest estimated value relating to the existing state in the observation space of the object to be observed and the position of the object. More specifically, the article-state change determination unit 203 sequentially determines whether or not any change in the existing state of an object, that is, “an article is taken out”, or “an article is placed”, has occurred, from the observed value acquired by the observed value acquiring means 201 and the estimated value of the past article position kept in the article-position estimated value table 206, each time the article-state change determination unit 203 receives an observed value.
Operations of the article-state change determination unit 203 will be described later in detail by reference to a flow chart.
When the article-state change determination unit 203 determines that “a change in the existing state of an article is present”, the article-state change determination unit 203 adds the observation time of the observed value used for the determination and the result of the determination as to the existing state of the article to an article-state change information table 204 to be recorded therein.
The article-state change information table 204 records article-state change information (information relating to any change in the existing state of an article, such as “an article is placed”, or “an article is taken out”) that has been determined by the article-state change determination unit 203, together with the observation time.
In
When the object-state change determination unit 203 determines that any change has taken place in the existing state of an object, the batch estimation unit 205 estimates the identification information and the position information of the object, based on an observed value obtained during a predetermined period of time from the time at which the object-state change determination unit 203 has determined that there is the change in the existing state of the object and the existing state of the object determined by the object-state change determination unit 203. More specifically, based on determination result information from the article-state change determination unit 203, the batch estimation unit 205 receives observed values obtained in a fixed elapsed period of time from the time at which the article-state change determination unit 203 has determined that “a change in the existing state of an article is present” from the observed value accumulating table 202, and executes a batch estimation process, with a group of observed values over a plurality of periods of time being used as inputs.
Operations of the batch estimation unit 205 will be explained later.
In a case where the batch estimation unit 205 has determined that there is any contradiction between the result of any change in the existing state of the article determined by the article-state change determination unit 203 and the existing state of the article as the result of article position estimated by the batch estimation unit 205, the batch estimation unit 205 rewrites the article-state change information on the article-state change information table 204 based on the result of estimated article position by the batch estimation unit 205. The estimated position in the world coordinate system for each of the articles estimated by the batch estimation unit 205 is added to an article-position estimated value table 206 together with the time information to be recorded thereon. In this case, as the time information to be recorded, the observed time for the first observed value among the group of observed values used in the batch estimation is used.
The article-position estimated value table 206 records information of the estimated position for each of the articles estimated by the batch estimation unit 205.
When receiving a request from the article position display operating mouse 211 through the article position display unit 210 so as to output position information for a specific article at a certain point of time, the article position estimated value output unit 207 outputs the past position estimated value closest to the corresponding time among pieces of position information for each of the articles recorded on the article-position estimated value table 206. However, in a case where no position information relating to the specified article is present, that is, for example, in a state where the specified article has been taken out by a person or the like, information representing “under transportation” is outputted from the article position estimated value output unit 207 in place of outputting the position information of the specified article.
Supposing that estimated positions of articles are recorded as shown in an example of
A rectangular region 802 represents an ID of an article that is being transported by a person or the like (an article whose position estimation is not available, that is, an article with no position information). The example of
In the rectangular region 803, the user sets time of an article position that the user wants to know. The user operates the article-position display operating mouse 211 to move a mouse pointer 804 inside the display screen 210a so that by clicking “a return button” or “a proceed button” of the rectangular region 803 to increase or decrease the value of time t displayed on the right end of the rectangular region 803, the time of the article position to be desirably known is specified.
Each time the user sets time of an article position to be desirably known by operating the article-position display operating mouse 211, the article position display unit 210 requests the article position estimated value output unit 207 to send position information of the article at the corresponding time, receives an article position estimated value from the article position estimated value output unit 207, and displays the position of each of the articles and the ID of an article that is being transported by a person or the like, respectively in the rectangular region 801 and the rectangular region 802.
Referring to
In the following explanation of the operations of the object position estimation apparatus 200, the explanation will be given on the assumption that a change in the existing state of each of articles occurs as shown in an upper half of chart 14A of a timing chart of
Since the article is stationary except that it is being carried by a person, the article position is represented by a straight line orthogonal to the position axis in chart 14A. On the other hand, although the article performs an optional motion while being carried by a person, since the position of the article while being carried is not a subject to be estimated, the motion of the article is represented by a straight line (broken line) in chart 14A for convenience of explanation.
In chart 14A, the time and position of each of articles having a change in the article existing state (the time and position at which an article is “taken out” or “placed”) is indicated by a white circle “O”, and in a case where the article is placed, “O” is displayed inside the white circle “O”, while in a case where the article is taken out, “T” is displayed inside the white circle “O”.
Chart 14A represents changes in the existing state of articles, in which article ID=0004 is placed at time t1, article ID=0004 is taken out at time t5, article ID=0001 and article ID=0002 are taken out at time t8, article ID=0001 is placed at time t11, and article ID=0004 is placed at time t14. The chart indicates that no change takes place in article ID=0003 during a period from time t1 to time t16.
In response to the changes in the existing state of articles shown in
The observed value acquiring process in step S100 in
Next, an article-state change determination process in step S200 is executed by the article-state change determination unit 203 in the object position estimation apparatus 200 of
Referring to a flow chart of
In the flow chart of
Processes from step S203 to step S206 are those processes carried out by the article-state change determination unit 203 as to which article has been placed when an article is newly placed.
Processes from step S207 to S209 are those processes carried out by the article-state change determination unit 203 as to which article has been taken out when any article is taken out.
Step S210 corresponds to a process to be carried out in the article-state change determination unit 203 when no change in the existing state of an article is found. In step S201, the article-state change determination unit 203 calculates an association likelihood defined by the following (formula 1), with respect to all the combinations between a plurality of observed values obtained from the observed value acquiring unit 201 at the current time and the latest article position estimated value for each of the articles at the current time, recorded on the article-position estimated value table 206. Supposing that the number of the article position estimated values is N, and that the number of observed values that have been obtained is M, M×N number of association likelihoods are calculated by the article-state change determination unit 203.
p(y|X,r=j)=ppos(ypos|X,r=j)·pID(yID|X,r=j) [Equation 1]
where
y=(yID,ypos) (Formula 1)
The association likelihood is a value representing certainty of correspondence between an actual article and an observed value and can be mathematically formulated on a basis of theory of probability. In the left side of (formula 1), supposing that the number of article position estimated values is N, X represents a combined vector of article-position estimated values corresponding to the N-number, and y represents a vector of observed values in which observed ID likelihood yID and observed position likelihood ypos are combined with each other. In this case, r represents a state variable representing which article is observed by y among N-number of articles, and in the case of r=j, this means that the article having an article ID of j has been observed. The left side of (formula 1) represents a probability with a condition in which, when a certain article position estimated value vector X is given and the article is observed, the observed value vector y can be obtained.
In the right side of (formula 1), ppos(ypos|X, r=j) represents a likelihood relative to the position of a j-numbered article of ypos corresponding to the observed position of the observed value vector y. Moreover, the right side of (formula 1), pID|yID|X, r=j) is a term corresponding to the observed ID likelihood of the observed values. In the present first embodiment, as represented by the right side of (formula 1), the likelihood of the article position and the observed ID likelihood are formulated by using models that are mutually independent.
(Formula 2) is a formula for use in defining ppos(ypos|X, r=j) of (formula 1). In the present first embodiment, the positional error characteristic of the article-image recognizing sensor 209 is supposed to be approximated by using a three-dimensional normal distribution. In (formula 2), d represents the number of dimensions of positional coordinates, and d=3 holds. Moreover, x represents three-dimensional coordinate values of the estimated position of an article having an article ID of j, ypos represents three-dimensional coordinate values of the observed value at the observed position. Here, Σ represents a 3×3 matrix that is a covariance matrix representing the positional error characteristic of the article-image recognizing sensor 209. In particular, in a case where no correlation exists among positional errors of the respective dimensions, a diagonal matrix is formed with diagonal components forming a variance of errors in the respective dimensions. With respect to this Σ, position measuring experiments of each article are preliminarily carried out by the article-image recognizing sensor 209 so as to obtain the corresponding value.
(Formula 3) is a formula for use in defining pID(yID|X, r=j) of (formula 1). In this case, Cj is an identification rate relating to an article whose article ID is j of the article-image recognizing sensor 209. Moreover, N represents the number of articles serving as subjects to be observed. In the present first embodiment, it is supposed that the observation ID likelihood is formulated by (formula 3). In other words, it is supposed that upon observation of an article whose article ID is j, a likelihood in the observation ID likelihood relative to the article ID of j is represented by Cj and that a likelihood relative to the article ID of not j is obtained by (1−Cj)/(N−1). In this definition, upon observation of an article whose article ID is other than j, the probability of erroneously identifying the article as an article whose article ID is j is defined as the same probability with respect to all the articles other than the article whose article ID is j. As described in the explanation relating to the article-image recognizing sensor 209, the value of Cj is preliminarily obtained by carrying out identifying experiments of articles by the article-image recognizing sensor 209.
In step S202, the number of observed values M and the number of article position estimated values N used for calculating the likelihood in step S201 are compared with each other in the article-state change determination unit 203 so that a condition branching process is carried out.
The contents of the condition branching process are explained as the following three cases:
1) In a case where M>N, the sequence proceeds to step S203 (in a case where an article is newly placed),
2) in a case where M=N, the sequence proceeds to step S210 (in a case where there is no change in the existing state of articles), and
3) in a case where M<N, the sequence proceeds to step S207 (in a case where an article is taken out).
The following will describe processes from step S203 to step S206 corresponding to processes in which an object is newly placed. A specific example of the processes is given based on the results of calculations on the likelihood at time t1 shown in
The following will first briefly describe a flow of processes from step S203 to step S206: in step S203 and step S204, the article-state change determination unit 203 determines which observed value does not correspond to any of the articles that are currently placed. Next, in step S205, the article-state change determination unit 203 determines which article the observed value that does not correspond to any of the articles is derived from, and in step S206, the article-state change determination unit 203 outputs the resulting value as the determination results in the article existing state.
In step S203, with the article ID of the article position estimated value being fixed based on the likelihood calculated in step S201, the order of the sizes of the association likelihoods is determined by the article-state change determination unit 203. For example, the article-state change determination unit 203 compares the sizes of the likelihood in the column direction of the table of the calculation results of likelihoods of
Next, in step S204, after the article-state change determination unit 203 determines the order of association likelihoods in step S203, an observed value whose association likelihood is not maximized relative to any of the article ID's is specified.
In the table of the calculation results of association likelihoods of
Next, in step S205, the article-state change determination unit 203 specifies an article ID having the highest likelihood among the observation ID likelihoods of the observed values, specified in step S204.
Based on the results of calculations of the association likelihood in
Next, in step S206, an article having the article ID specified in step S205 is determined by the article-state change determination unit 203 as “an article that has been newly placed”, and the article-state change determination unit 203 outputs a result of determination in the change of the article-existing state indicating that “the corresponding article ID has been placed” as the output of step S200.
Based on the calculation results of association likelihood of
The following will describe a process of step S210 corresponding to a state where no change occurs in the article-existing state. In this step, the fact that “no change occurs in the article-existing state” is outputted as an output from the article-state change determination unit 203. Ata point of time t4 in
The following will describe processes from step S207 to step S209 corresponding to a case where an article is taken out. A specific example of the processes is given based on the results of calculations on the likelihood at time t5 shown in
The following will first briefly describe a flow of processes from step S207 to step S209: in step S207 and step S208, the article-state change determination unit 203 determines which article among the articles does not correspond to the observed value obtained. Next, in step S209, the article-state change determination unit 203 outputs the determination results in the article existing state indicating that an article ID has been taken out, which is determined in step S208.
In step S207, with the observed value being fixed to one value relative to the association likelihood calculated in step S201, the order of the sizes of the association likelihoods is determined by the article-state change determination unit 203. For example, the article-state change determination unit 203 compares the sizes of the likelihood in the row direction of the table of the calculation results of association likelihoods of
Next, in step S208, after determining the order of association likelihoods in step S207 by the article-state change determination unit 203, an article ID whose association likelihood is not maximized relative to any of the observed values is specified.
When explained by reference to the example of
Next, in step S209, the article-state change determination unit 203 determines that an article having the article ID specified in step S208 corresponds to “an article that has been taken out”, and the article-state change determination unit 203 outputs a result of determination in the change of the article-existing state indicating that “the corresponding article ID has been taken out” as the output of step S200.
Based on the calculation results of association likelihood of
The above is the explanation of the article-state change determination process in step S200. Returning again to the flow chart of
In step S300 following step S200, in a case where the article-state change determination unit 203 has determined that there is any change in the article-existing state in the process of step S200, the sequence is branched to step S400, while in a case where the article-state change determination unit 203 has determined that there is not any change in the article-existing state in the article-state change determination unit 203, the sequence returns to step S100.
In step S400, in response to the output of the determination result in the article-existing state change from the article-state change determination unit 203 in step S200, the change in the article-existing state is recorded in the article-state change information table 204 by the article-state change determination unit 203. The contents to be recorded are the same as those explained in the article-state change information table 204.
Step S500 is a batch estimation process of an article position that is carried out by the batch estimation unit 205 when there is any change in the article-existing state.
Referring to a flow chart of
In step S501 in
Additionally, in this case, with respect to a period of time (or a number of acquiring times) in which observed values are acquired, it is fixed within a range so as to preliminarily obtain desired positional precision (an upper limit of positional deviations) through experiments, and is also fixed so that a period of time up to completion of the position-estimating process by the batch processing is within a range that causes no problems in the frequency of state changes in an article to be measured.
For example, in the object position estimating device 200 in the first embodiment, with respect to an article serving as a subject to be position-estimated, after the article has been brought into a stationary state, with a period of time in which an observed value is obtained by the observed value acquiring unit 201 from the article-image recognizing sensor 209 being changed (or with the number of times in which observed values are obtained being changed), a batch estimating process is carried out by the batch estimation unit 205 so that a minimum acquiring period of time for observed values which is capable of providing required positional precision (for example, several seconds, or a minimum number of acquiring times of observed values) is set to a constant period of time (or number of times).
In step S502, the observed value used when determined that there was a change in the article state in step S200 is acquired from the observed value accumulating table 202 together with the observed values acquired a plurality of times for the constant period of time in step S501 are acquired so that the batch estimation unit 205 carries out an article position estimating process by the batch estimation.
As the method for the batch estimation, an estimation algorithm capable of dealing with the correspondence relationship between a plurality of articles and a plurality of observed values on a probability basis is used. As the estimation algorithm for use in the batch estimation unit 205, for example, a method disclosed in (Non-Patent Document 1: “Localization and Identification of Multiple Objects with Heterogeneous Sensor Data by EM Algorithm”, SICE-ICASE international Joint Conference (SICE-ICCAS) 2006), written by Hirofumi Kanazaki, Takehisa Yairi, Junichi Shibata, Yohei Shirasaka and Kazuo Machida) is proposed. In the first embodiment, since the observed value obtained by the article-image recognizing sensor 209 contains likelihood (observation ID likelihood) relating to identification of an article, the EM algorithm with which the framework of data association disclosed in the above-mentioned Non-Patent Document is combined can be applied thereto.
The following will additionally describe the outline of the batch estimating process using the algorithm disclosed in Non-Patent Document 1.
In the following additional explanation, X represents a combined vector of an N-number of article-position estimated values, and xj,pos represents a j-numbered article estimated position. Here, Y represents a combined vector of an M-number of observed values that form an input for the batch estimation, and yi represents a i-numbered observed value. The yi forms a vector of observed values in which an observed ID likelihood yID and an observed position ypos are combined with each other. Moreover, rj represents a state variable indicating which article the observed value yj is derived from (for example, in the case of ri=j, the observed value yj represents a state in which the j-numbered article is observed). Additionally, the definitions of X, Y, and r are equivalent to definitions of the estimated value of an article position, the observed value of an article position (an article ID likelihood and an observed value) and the state variable indicating which article the observed value is derived from, in the present embodiment; therefore, it is noted that a specific batch estimation algorithm to be explained below is applicable to the batch estimating system for the batch estimation unit 205 of the present embodiment.
The batch estimation algorithm to be explained below is referred to as a MAP estimation method (maximum a posteriori estimation method), and by obtaining a value of X (X=X*) that maximizes a probability represented by p(X|Y), X, that is, an article position is estimated.
What is meant by X* obtained by the MAP estimation of this (formula 4) is that when receiving observation data Y, supposing that p(X|Y) is maximized when X=X*, X* represents a value of X that has the highest probability. In other words, X* is supposed to give a position having the highest probability as the article position.
Based on Bayes theorem, p(X|Y) is transformed into the following formula.
After transformed as indicated by (formula 5), the MAP estimation is carried out by an EM algorithm. The EM algorithm is an algorithm in which by iterating two calculation steps, that is, E-Step (estimating step) and M-Step (maximizing step), the MAP estimation is executed. It is supposed that X(t) corresponds to an estimate value of an article position X obtained by the t-numbered calculation of the repetitive calculations of the EM algorithm. The following steps show the EM algorithm for use in the MAP estimation of p(X|Y), which is transformed as shown in (formula 5).
Since from the definition of (formula 1) of the present embodiment, p(yi|X, ri=j)=PID (yi,ID|X, ri=j)·ppos (yi,pos|rj=j) holds, by substituting this for (formula 6), the following formula is obtained:
In this transformation, since N-number of articles are observed in the same frequency, ppos(ri,pos|X)=1/N is set in (formula 6).
With respect to Q(X|X(t) of (formula 7), in order to obtain X that maximizes M-Step of formula 6), that is Q(X|X(t)), by solving the following formula, the (succeeding formula 8) is obtained:
Moreover, with respect to α of (formula 6), the following formula is obtained.
In this transformation also, ppos(yi,pos|X)=1/N is set. Additionally, the right side of (formula 9) is obtained by substituting X=X(t+1) for (formula 1), (formula 2), and (formula 3) in the present embodiment. (Formula 8) and (formula 9) are updating formulas for use in obtaining X(t+1) from X and by carrying out repetitive calculations base on these updating formulas, X* can be obtained.
The initial value of an article estimated position in these iterative calculations is given as X(0).
The following will describe how to give the initial value of the article position estimation, upon starting a batch estimating process in the above-mentioned step S502.
In a case where an article is newly placed, with respect to articles that have no change in the existing state, the latest article position estimated value recorded in the article-position estimated value table 206 is used by the batch estimation unit 205 as an initial value for the article position estimation. As the initial value of the estimated position in an article position estimating process relating to the article newly placed, the observed position of the observed value specified in step S204 is used by the batch estimation unit 205. In a case where an article is taken out, the batch estimation unit 205 deals with the articles other than the article taken out as having no change in the existing state.
In step S503, the estimated position of each of the articles, obtained in step S502, is outputted from the batch estimation unit 205 as the result of the batch estimation.
The above is the explanation of the batch estimation process of the article position carried out by the batch estimation unit 205 in step S500.
Returning again to the flow chart of
In step S600 following step S500, the batch estimation unit 205 determines whether or not there is any contradiction between the existing state of each of the articles clarified by the estimation result of the batch estimation unit 205 in step S500 and the existing state of each of the articles determined by the article-state change determination unit 203 in step S200.
When the batch estimation unit 205 determines that there is any contradiction in step S600, in step S700, based on the estimation results from the batch estimation unit 205, the existing state of the articles inside the article-state change information table 204 is rewritten by the batch estimation unit 205.
The following will describe the reasons why the determining process in the batch estimation unit 205 in step S600 is required and why the rewriting process in the existing state of the articles inside the article-state change information table 204 by the batch estimation unit 205 in step S700 is required.
In step S205 in the process flow relating to the state in which an article is added in step S200, the article-state change determination unit 203 specifies that the article ID having the highest observation ID likelihood of observed values that does not correspond to any of the currently existing articles is an ID of the article that has been added. At this time, due to disturbances on the article observation, such as a temporary occlusion or fluctuations in illumination of the space to be observed, there is a possibility that the article-image recognizing sensor 209 might cause an erroneous identification of the article. In the case of the erroneous identification, the likelihood of an article ID that is not the ID of the article that has been actually added becomes higher, with the result that in step S200, the article-state change determination unit 203 might erroneously determine that an article having an erroneous article ID corresponds to the article that has been added, and in step S400, the article-state change determination unit 203 might record in the article-state change information table 204 that an article having an erroneous article ID has been “PUT”.
In this case, however, in step S500, since the batch estimation unit 205 carries out an estimating process of the article position based on a plurality of observed values within a predetermined period of time, the influences from the erroneous identification of the article due to a temporary disturbance can be suppressed so that the batch estimation unit 205 makes it possible to clarify that, finally, the article with a right article ID has been added.
Therefore, in step S600, the batch estimation unit 205 compares the existing state of the right article obtained by the batch estimating process of step S500 and the existing state of each of the articles recorded in the article-state change information table 204, and in a case where the batch estimation unit 205 determines that the two states are different from each other, the batch estimation unit 205 rewrites the contents of the article-state change information table 204 based on the results of the batch estimating process in step S500, in step S700.
With respect to a specific example of a process in which, upon occurrence of a contradiction in step S600 as described earlier, the rewriting process is carried out in step S700, and the explanation thereof will be given later, in detail.
When the batch estimation unit 205 determines that there is no contradiction in step S600, or after, in step S700 the batch estimation unit 205 has rewritten the contents of the article-state change information table 204 based on the results of the batch estimating process of step S500, the sequence proceeds to step S800.
In step S800, the article position estimated value for each of the articles, estimated by the batch estimation unit 205 in step S500, is recorded in the article-position estimated value table 206 by the batch estimation unit 205. With respect to the position estimated value to be recorded, the same value as explained in the article-position estimated value table 206 may be used. After the process in step S800, a sequence of object position estimating process operations are completed, or as shown in the Figure, the sequence returns to step S100.
With respect to the main processing steps of operation flows (
A chart 14B corresponding to the lower half of
During periods of time (t<t1, t3<t<t5, t7<t<t8, t10<t<t11, t13<t<t14, and t16<t) in which no state change in the articles occurs, observation value acquiring processes and determining processes of the state change in the articles from step S100 to step S300 are repeatedly carried out.
In the timing at which any state change in the article state (change in the article existing state) (t=t1, t5, t8, t11, and t14) occurs, after passing through step S400, the article-position estimating process of the batch estimation unit 205 is carried out in step S500. In step S500, a plurality of observed values are acquired (step S501), and after completion of the batch estimating process (step S502), in step S800, after recording the article position estimated value obtained in the batch estimation in the article-position estimated value table 206, the sequence returns to step S100, and the repetitive processes of step S100 to step S300 are resumed.
Additionally,
In the timing chart of
With respect to one observed value (1304 in
In the timing chart of
First, with respect to two observed values (1305 in
In the processes of step S203 and step S204, the article-state change determination unit 203 specifies an observed value (the first one from the top of 1305 of
In step S205, since, among the observed ID likelihoods of the specified observed value, the article ID that has a maximum value is 0001, the article-state change determination unit 203 specifies that the corresponding article ID is 0001 so that the article-state change determination unit 203 determines that not article ID=0004, but article ID=0001, is placed.
Based on a specific example, the following will additionally explain the processes of step S600 and step S700 in the flow of
In the timing chart of
With respect to observed values 1306 and the latest article-position estimated value (an article position estimated value at t=t11 of
Moreover, in step S400, the article-state change determination unit 203 records in the article-state change information table 204 that article ID 0002 has been “PUT”.
Next, in the batch estimating process in step S500, since the estimating process of the article position is carried out by using observed values obtained over a plurality of times as inputs, the batch estimation unit 205 is allowed to execute the estimation by using the observed values together with observed values without an identification error obtained after observed values 1306 temporarily containing an identification error of articles; thus, the influences of observed values 1306 that erroneously identify article ID=0004 as article ID=0002 are suppressed so that as a result, the estimation results indicating that article ID=0001, article ID=0003, and article ID=0004 are present can be obtained by the batch estimation unit 205.
Therefore, in step S600, the batch estimation unit 205 collates the article-state change information recorded in the article-state change information table 204 so that the batch estimation unit 205 determines that the information that article ID=0002 has been “PUT” contradicts the batch estimation result. For this reason, in step S700, the batch estimation unit 205 deletes the information indicating that article ID=0002 has been “PUT” recorded in the article-state change information table 204, and the batch estimation unit 205 rewrites the information with information that article ID=0004 has been “PUT” in the article-state change information table 204.
Therefore, even when the article-state change determination unit 203 has made an erroneous determination on the change in the article state due to a temporarily erroneous article identification information of the article-image recognizing sensor 209, the article state information to be recorded in the article-state change information table 204 is revised correctly by the article position estimating process in the batch estimation unit 205 using a plurality of observed values.
Lastly, referring to a flow chart in
In step S900 of
Next in step S1000, the article position display unit 210 requests the article position estimated value output unit 207 to send information of the article position at the time set in step S900.
Next, in step S1100, the article position estimated value output unit 207 acquires information of an article position estimated value at the requested time from the article-position estimated value table 206 and outputs the value to the article position display unit 210.
In step S1200, the estimated value of the article position received by the article position display unit 210, and information as to which article is being under transportation are displayed in the rectangular region 801 and the rectangular region 802 of the display screen 210a of the article position display unit 210.
As shown in chart 14A of
In accordance with the structure of the first embodiment, a degree of certainty of correspondence relationship between each of a plurality of observed values obtained from a plurality of articles and each of a plurality of the latest article states to be recorded in the article position estimated value table 206 is calculated as the association likelihood by the article-state change determination unit 203 so that the article-state change determination unit 203 can determine which article has been placed or which article has been taken out. With this arrangement, presence or absence of a change in the existing state of an article can be detected, and only in a case where there is a change in the existing state of articles, the position of the article is estimated with high precision by the batch estimation unit 205, while in a case where there is no change in the existing state of articles, the estimated result of the article position with high precision, obtained by the batch estimation and recorded in the article position estimated value table 206, can be outputted as the estimated result of the article position.
In other words, in accordance with the object position estimation apparatus 200 and an object position estimation method carried out by the object position estimation apparatus 200, as well as the object position estimation program that forms the object position estimation apparatus 200 as a program, it is possible to provide a remarkable effect in that, upon observation of a plurality of semi-stationary articles (for example, such articles as to move and stop repeatedly), after a position of each article has been determined with high precision by using a batch estimating process in synchronized timing with a change in the article state from a moving state to a stationary state, during a stationary state of the article, the position information with high precision obtained by the batch estimation can be outputted as estimated information.
Moreover in accordance with the object position estimation apparatus 200 and the object position estimation method carried out by the object position estimation apparatus 200, as well as the object position estimation program that forms the object position estimation apparatus 200 as a program, it is also possible to provide an effect in that, the article-state change determination unit 203 determines a state change from a stationary state to a moving state of an article to be observed, or a state change from a moving state to a stationary state thereof, so that, with respect to all the articles, a stationary state of each article or a moving state thereof can be confirmed at an optional point of time during the observation.
The present invention is not intended to be limited by the above-mentioned embodiments, and may be carried out in various other aspects.
For example, in the first embodiment, the estimated result of an article position is displayed on the article position display unit 210; however, as the application mode of the estimated position of the article, an input to another device that calls for knowing the position of the article may also be used, and the scope of the present invention is not limited by this mode.
Moreover, with respect to the object, not limited to the above-mentioned articles, for example, persons or animals, such as pet animals may be used. In short, the object that forms a subject in the present invention refers to an object capable of being transported by a person.
In the above-mentioned embodiment, each of the object-state change determination means 101, 203, the batch estimation means 102, 205, the object state information storage means 103, 204, 206, and the like, or optional portions thereof may include software. Therefore, a computer program that has steps forming control operations of the respective embodiments of the present specification may be prepared, and this may be readably stored in a recording medium such as a storage device (a hard disk or the like); thus, the computer program may be read into a temporary storage device (a semiconductor memory, or the like) of a computer, and the program is executed by a CPU so that the above-mentioned functions or respective steps can be executed.
By properly combining the arbitrary embodiments of the aforementioned various embodiments, the effects possessed by the embodiments can be produced.
The object position estimation apparatus, the object position estimation method, and the object position estimation program in accordance with the present invention can be utilized for a device used for estimating positions of a plurality of objects (for example, a plurality of articles) that exist in a space to be observed, and might be transported at an arbitrary timing. For example, these can be applied to a system for managing article positions in a home, or a life assistant robot that autonomously transports an article that is called for by the user.
Although the present invention has been fully described in connection with the preferred embodiments thereof with reference to the accompanying drawings, it is to be noted that various changes and modifications are apparent to those skilled in the art. Such changes and modifications are to be understood as included within the scope of the present invention as defined by the appended claims unless they depart therefrom.
Number | Date | Country | Kind |
---|---|---|---|
2010-046168 | Mar 2010 | JP | national |
This is a continuation application of International Application No. PCT/JP2010/007557, filed Dec. 27, 2010.
Number | Date | Country | |
---|---|---|---|
Parent | PCT/JP2010/007557 | Dec 2010 | US |
Child | 13248380 | US |